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Prefacio 


Por lo general, los científicos tienen la sensación de que por medio de su traba¬ 
jo están aprendiendo sobre algún aspecto de ellos mismos. Los físicos ven esta 
conexión en su trabajo; e igual pasa con los psicólogos y los químicos. En la re¬ 
botica, la conexión entre el campo de estudio y nosotros mismos es inusualmen¬ 
te obvia. Y, a diferencia de una ciencia que solamente analiza, el objetivo actual 
de la robótica requiere que la ingeniería se desvíe hacia la síntesis. Tal vez por 
eso sea tan fascinante para muchos de nosotros el estudio de esta ciencia. 

La robótica se relaciona en sí con el deseo de sintetizar algunos aspectos 
de la función humana mediante el uso de mecanismos, sensores, actuadores y 
computadoras. Obviamente esto representa un enorme compromiso que evi¬ 
dentemente parece requerir una multitud de ideas provenientes de varios cam¬ 
pos “clásicos”. 

En la actualidad expertos de varios campos trabajan en la investigación de 
distintos temas de la robótica. Generalmente, no es común que un solo individuo 
domine todos los campos de la robótica. Es natural esperar una subdivisión. En 
un nivel relativamente alto de abstracción parece razonable dividir la robótica 
en cuatro áreas principales: manipulación mecánica, locomoción, visión compu- 
tacional e inteligencia artificial. 

Este libro introduce la ciencia y la ingeniería de la manipulación mecáni¬ 
ca. Esta subdisciplina de la robótica tiene su base en varios campos clásicos; y 
los más relevantes son la mecánica, la teoría de control y la ciencia computacio- 
nal. Los capítulos del 1 al 8 tratan temas relacionados con la ingeniería mecáni¬ 
ca y las matemáticas. Del 9 al 11 cubren todo lo relacionado con la teoría de 
control, y los capítulos 12 y 13 pueden clasificarse como material relacionado 
con la ciencia computacional. A pesar de esta división, en todo el libro se enfa¬ 
tizan los aspectos computacionales de los problemas; por ejemplo, cada capítu¬ 
lo relacionado con la mecánica tiene una breve sección dedicada a las 
consideraciones computacionales. 

Este libro evolucionó a partir de los resúmenes utilizados en clase para im¬ 
partir la materia “Introducción a la Robótica”, en la Universidad de Stanford, du¬ 
rante las clases de otoño de 1983 a 1985. Las primeras dos ediciones se utilizaron 
en muchas instituciones de 1986 hasta 2002. La tercera edición se beneficia de es¬ 
te uso e incorpora correcciones y muchas mejoras gracias a la retroalimentación 
recibida. Agradecemos a todos aquellos que han enviado correcciones del texto 
al autor. 

El libro es apropiado para un curso a nivel de los últimos dos años de li¬ 
cenciatura o del primer año de maestría. Será de mayor utilidad si el estudian¬ 
te ha llevado un curso básico de estática y dinámica, uno de álgebra lineal, y si 
puede programar en un lenguaje de alto nivel. Además es conveniente, aunque 
no absolutamente necesario, que haya completado un curso introductorio en 
teoría de control. Uno de los objetivos del libro es presentar el material de una 
manera simple e intuitiva; no es necesario que la audiencia esté formada estric¬ 
tamente por ingenieros mecánicos, aunque la mayor parte del material se toma 
de ese campo. En Stanford, a muchos ingenieros eléctricos, científicos computa¬ 
cionales y matemáticos les pareció bastante legible el libro. 
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De manera directa, este libro es para que lo utilicen todos aquellos ingenieros que 
desarrollan sistemas robóticos, pero el material debe verse como una plataforma im¬ 
portante para cualquiera que tenga algo que ver con la robótica. De manera muy pare¬ 
cida a como los desarrolladores de software generalmente estudian, cuando menos, 
algo de hardware, quienes no estén directamente involucrados con la mecánica y el con¬ 
trol de robots deben tener una base similar a la que se ofrece aquí. 

El material se adapta fácilmente a un curso de un semestre académico; para impar¬ 
tir el material en un trimestre probablemente se requiera omitir uno o dos capítulos; e 
incluso a ese ritmo no podrán cubrirse todos los temas con mucha profundidad. En cier¬ 
ta manera el libro está organizado con esto en mente; por ejemplo, la mayoría de los ca¬ 
pítulos presenta solamente un enfoque para resolver el problema en cuestión. Uno de 
los retos al escribir este libro fue tratar de hacer justicia a los temas cubiertos dentro de 
las restricciones de tiempo que se presentan generalmente al impartir clases. El méto¬ 
do empleado para este fin fue considerar solamente el material que afecta directamen¬ 
te al estudio de la manipulación mecánica. 

Al final de cada capítulo se presenta un conjunto de ejercicios, donde cada ejerci¬ 
cio tiene asignado un factor de dificultad, indicado entre corchetes después del núme¬ 
ro del ejercicio. Los niveles de dificultad varían entre [00] y [50], en donde [00] es un 
problema trivial y [50] es una investigación sin resolver. 1 Desde luego, lo que para una 
persona pudiera ser difícil, a otra podría resultarle sencillo, por lo que para algunos lec¬ 
tores los niveles parecerán incorrectos en algunos casos; sin embargo, se ha hecho un 
esfuerzo por estimar la dificultad de los ejercicios. 

En la parte final de cada capítulo hay una tarea de programación en la que el es¬ 
tudiante debe aplicar el contenido del capítulo correspondiente a un manipulador pla- 
nar simple de tres articulaciones. Este manipulador simple es lo suficientemente 
complejo como para demostrar casi todos los principios de los manipuladores genera¬ 
les sin necesidad de azorar al estudiante con demasiada complejidad. Cada tarea de 
programación se basa en las anteriores, con lo que al final del curso contará con una bi¬ 
blioteca completa de software de manipulador. 

Adicionalmente, en esta tercera edición hemos agregado ejercicios de MATLAB: 
un total de 12 ejercicios se encuentran asociados con los capítulos del 1 al 9. El profe¬ 
sor Robert I. Williams II de la Universidad de Ohio es el desarrollador de estos ejerci¬ 
cios; estamos profundamente agradecidos con él por esa contribución. Estos ejercicios 
pueden utilizarse con la Caja de Herramientas de Robótica MATLAB 2 creada por Pe- 
ter Corke, Director de investigación de la CSIRO en Australia. 

El capítulo 1 es una introducción al campo de la robótica. Presenta cierto material 
básico, unas cuantas ideas fundamentales y la notación adoptada en el libro; además, 
muestra un avance de los capítulos siguientes. 

El capítulo 2 trata acerca de las matemáticas utilizadas para describir posiciones 
y orientaciones en el espacio tridimensional. Este material es extremadamente impor¬ 
tante: por definición, la manipulación mecánica se refiere al desplazamiento de obje¬ 
tos (piezas, herramientas, el robot en sí) en el espacio. Necesitamos formas de describir 
esas acciones de una manera que sea fácilmente comprensible y lo más intuitiva posi¬ 
ble. 


1 He adoptado la misma escala que en la obra The Art of Computer Programming de D. Knuth (Addison- 
Wesley). 

2 Para mayor información sobre la Caja de Herramientas de Robótica MATLAB, visite 
http://www.ict.csiro.au/robotics/ToolBox7.htm. 
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Los capítulos 3 y 4 presentan la geometría de los manipuladores mecánicos. Intro¬ 
ducen la rama de la ingeniería mecánica conocida como cinemática: el estudio del mo¬ 
vimiento sin considerar las fuerzas que lo ocasionan. Estos capítulos tratan con la 
cinemática de los manipuladores, pero restringiéndose a los problemas de posiciona- 
miento estático. 

El capítulo 5 expande nuestra investigación de la cinemática a las velocidades y 
fuerzas estáticas. 

El capítulo 6 trata por primera vez las fuerzas y los momentos requeridos para 
producir el movimiento de un manipulador. Este es el problema de la dinámica de los 
manipuladores. 

El capítulo 7 se relaciona con la descripción de los movimientos del manipulador 
en términos de trayectorias a través del espacio. 

El capítulo 8 ofrece muchos temas relacionados con el diseño mecánico de un ma¬ 
nipulador. Por ejemplo, ¿cuántas articulaciones son apropiadas, de qué tipo deben ser y 
cómo deben ordenarse? 

Los capítulos 9 y 10 estudian métodos para controlar un manipulador (general¬ 
mente con una computadora digital) de manera que rastree fielmente una trayectoria 
de posición deseada a través del espacio. El capítulo 9 restringe la atención a los méto¬ 
dos de control lineal, mientras que el capítulo 10 extiende estas consideraciones al ám¬ 
bito no lineal. 

El capítulo 11 cubre el campo del control de la fuerza activa con un manipulador. 
Es decir, sobre cómo controlar la aplicación de fuerzas mediante el manipulador. Este 
método de control es importante cuando el manipulador entra en contacto con el en¬ 
torno que lo rodea; por ejemplo, al lavar una ventana con una esponja. 

El capítulo 12 da un vistazo general a los métodos de programación de robots; 
específicamente los elementos necesarios en un sistema de programación de robots y 
los problemas específicos asociados con la programación de robots industriales. 

El capítulo 13 presenta la simulación fuera de línea y los sistemas de programa¬ 
ción; es decir, la última extensión para la interfaz hombre-robot. 

Quiero agradecer a todas las personas que han contribuido con este libro. En pri¬ 
mer lugar, agradezco a los estudiantes de ME219 de Stanford su tiempo durante los cur¬ 
sos de otoño de 1983 a 1985, quienes sufrieron con los primeros borradores: encontraron 
muchos errores y brindaron infinidad de sugerencias. El profesor Bernard Roth ha con¬ 
tribuido de muchas maneras, tanto a través de sus críticas constructivas como propor¬ 
cionándome un entorno para completar la primera edición. En SILMA Inc. disfruté de 
un ambiente estimulante, además de contar con los recursos que me ayudaron a com¬ 
pletar la segunda edición. El Dr. Jeff Kerr escribió el primer borrador del capítulo 8. El 
profesor Robert L. Williams II contribuyó con los ejercicios de MATLAB que se en¬ 
cuentran al final de cada capítulo, y Peter Corke expandió su caja de Herramientas de 
Robótica para apoyar el estilo de la notación Denavit-Hartenberg utilizado en este 
libro. Tengo una deuda con mis anteriores mentores en robótica: Marc Raibert, Cari 
Ruoff,Tom Binford y Bernard Roth. 

Muchas otras personas de Stanford, SILMA, Adept y de otras instituciones tam¬ 
bién han ayudado de diversas formas; mi agradecimiento a John Mark Agosta, Mike Ali, 
Lynn Balling, Al Barr, Stephen Boyd, Chuck Buckley, Joel Burdick, Jim Callan, Brian 
Carlisle, Monique Craig, Subas Desa, Tri Dai Do, Karl Garcia, Ashitava Ghosal, Chris 
Goad, Ron Goldman, Bill Hamilton, Steve Holland, Peter Jackson, Eric Jacobs, Johann 
Jáger, Paul James, Jeff Kerr, Oussama Khatib, Jim Kramer, Dave Lowe, Jim Maples, 
Dave Marimont, Dave Meer, Kent Ohlund, Madhusudan Raghavan, Richard Roy, 
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Ken Salisbury, Bruce Shimano, Donalda Speight, Bob Tilove, Sandy Wells y Dave Wi¬ 
lliams. 

Los estudiantes de la clase de Robótica de 2002, impartida por el profesor Roth, 
en Stanford, utilizaron la segunda edición y enviaron muchas observaciones de errores 
que se corrigieron para esta tercera edición. 

Finalmente, deseo agradecer a Tom Robbins de Prentice Hall por su supervisión 
con la primera edición y ahora de nuevo con esta tercera edición. 
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CAPÍTULO 1 


Introducción 


1.1 ANTECEDENTES 

1.2 LA MECÁNICA Y EL CONTROL DE LOS MANIPULADORES MECÁNICOS 

1.3 NOTACIÓN 


1.1 ANTECEDENTES 

La historia de la automatización industrial está caracterizada por periodos de cambios brus¬ 
cos en los métodos populares. Ya sea como causa o, tal vez, como un efecto, dichos pe¬ 
riodos de cambio en las técnicas de automatización parecen estar estrechamente 
ligados con la economía mundial. El uso del robot industrial, que se identificó como 
dispositivo único en la década de 1960 [1], junto con los sistemas de diseño asistido por 
computadora (CAD) y manufactura asistida por computadora (CAM), caracteriza las 
tendencias más recientes en la automatización del proceso de manufactura. Estas tec¬ 
nologías están llevando a la automatización industrial hacia otra transición, cuyo alcan¬ 
ce se desconoce aún [2]. 

En los Estados Unidos hubo mucha adopción de equipo de robótica a principios 
de la década de 1980, a la cual le siguió un breve retraso a finales de esa misma déca¬ 
da. A partir de ese momento el mercado ha estado creciendo (figura 1.1), aunque está 
sujeto a las variaciones económicas, como pasa con todos los mercados. 

En la figura 1.2 se muestra el número de robots instalados por año en las princi¬ 
pales regiones industriales del mundo. Observe que Japón reporta números de una ma¬ 
nera algo distinta a las demás regiones: cuentan como robots algunas máquinas que en 
otras partes del mundo no se consideran así (se consideran simplemente como “máqui¬ 
nas de fábrica”). Por ende, los números reportados para Japón están algo inflados. 

Una de las principales razones del crecimiento en el uso de robots industriales es 
la reducción en el costo. En la figura 1.3 se indica que, durante la década de 1990, los 
precios de los robots disminuyeron al mismo tiempo que aumentaron los costos de ma¬ 
no de obra humana. Además, los robots no sólo se están volviendo más baratos, sino 
también más efectivos: más rápidos, precisos y flexibles. Si factorizamos en los núme¬ 
ros estos ajustes de calidad, el costo por utilizar robots disminuye mucho más rápido 
que su etiqueta de precio. A medida que los robots se vuelvan más efectivos en cuanto 
al costo por sus tareas, y a medida que aumente el costo de la mano de obra humana, 
habrá más trabajos que se conviertan en candidatos para la automatización robótica. 
Esta es la tendencia individual más importante que impulsa el crecimiento del merca¬ 
do de los robots. Una tendencia secundaria es que, haciendo a un lado la economía, a 
medida que los robots se vuelvan más capaces , podrán hacer más y más tareas que se¬ 
rían peligrosas o imposibles de realizar por los trabajadores humanos. 

Las aplicaciones que llevan a cabo los robots industriales se están volviendo cada 
vez más sofisticadas pero aún se da el caso de que, como en el año 2000, aproximada¬ 
mente el 78% de los robots instalados en los EE.UU. fueron robots para soldadura o 
manejo de materiales [3]. 
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Envíos de robots industriales en Estados Unidos, millones de dólares estadounidenses. 
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FIGURA 1.1: Envíos de robots industriales en Estados Unidos, en millones de dólares 
estadounidenses [3]. 
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FIGURA 1.2: Instalaciones por año de robots industriales de propósitos múltiples para 
los años 1995-2000 y las proyectadas para los años 2001-2004 [3]. 



FIGURA 1.3: Precios de los robots comparados con los costos de la mano de obra 
humana en la década de 1990 [3]. 
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FIGURA 1.4: El manipulador Adept 6 tiene seis articulaciones giratorias y es popular en 
muchas aplicaciones. Cortesía de Adept Technology, Inc. 


Un dominio que ofrece un mayor reto, el ensamblaje por un robot industrial, contabi¬ 
lizó el 10% de las instalaciones. 

Este libro se enfoca en la mecánica y el control de la forma más importante del 
robot industrial: el manipulador mecánico. Algunas veces se debate sobre qué es lo que 
constituye exactamente a un robot industrial. Dispositivos como los que se muestran en 
la figura 1.4 siempre se incluyen, mientras que las máquinas fresadoras controladas nu¬ 
méricamente (NC) generalmente no. La distinción está en alguna parte de la sofistica¬ 
ción de la capacidad de programación del dispositivo; si un dispositivo mecánico puede 
programarse para realizar una amplia variedad de aplicaciones, probablemente sea un 
robot industrial. Las máquinas que en su mayor parte están limitadas a una clase de ta¬ 
rea se consideran como de automatización lija. Para los fines de este texto, no necesi¬ 
tan debatirse las distinciones; la mayor parte del material es de una naturaleza básica 
que se aplica a una amplia variedad de máquinas programables. 

El estudio de la mecánica y el control de manipuladores no es una ciencia nueva, 
sino simplemente una colección de temas provenientes de campos “clásicos”. La inge¬ 
niería mecánica contribuye con metodologías para el estudio de máquinas en situacio¬ 
nes estáticas y dinámicas. Las matemáticas proveen de herramientas para describir los 
movimientos espaciales y demás atributos de los manipuladores. La teoría de control 
proporciona herramientas para diseñar y evaluar algoritmos para realizar los movi¬ 
mientos deseados o las aplicaciones de fuerza. Las técnicas de la ingeniería eléctrica se 
aplican en el diseño de sensores e interfaces para robots industriales y la ciencia 
computacional contribuye con la base para programar estos dispositivos para realizar 
la tarea deseada. 
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1.2 LA MECÁNICA Y EL CONTROL DE LOS MANIPULADORES MECÁNICOS 

En las siguientes secciones presentaremos brevemente cada uno de los temas que cu¬ 
brirá el texto, así como alguna terminología. 

Descripción de posición y orientación 

En el estudio de la robótica nos preocupamos constantemente por la ubicación de los 
objetos en el espacio tridimensional. Estos objetos son los vínculos del manipulador, las 
piezas y herramientas con las que trabaja y los demás objetos en el entorno del manipu¬ 
lador. A un nivel básico pero importante, estos objetos se describen mediante sólo dos 
atributos: posición y orientación. Naturalmente, un tema de interés inmediato es la ma¬ 
nera en la que representamos estas cantidades y las manipulamos matemáticamente. 

Para poder describir la posición y orientación de un cuerpo en el espacio, siem¬ 
pre adjuntamos rígidamente un sistema de coordenadas, o trama, al objeto. Después 
describimos la posición y orientación de esta trama con respecto a algún sistema de 
coordenadas de referencia. (Vea la figura 1.5). 

Cualquier trama puede servir como sistema de referencia dentro del cual se pue¬ 
da expresar la posición y orientación de un cuerpo, por lo que a menudo pensamos en 
transformar o cambiar ¡a descripción de estos atributos de un cuerpo de una trama a 
otra. El capítulo 2 explica las convenciones y metodologías para tratar la descripción de 
la posición y la orientación, y las matemáticas para manipular estas cantidades respec¬ 
to a varios sistemas de coordenadas. 

Es muy útil desarrollar buenas habilidades respecto a la descripción de la posición 
y la rotación de cuerpos rígidos, incluso en campos externos a la robótica. 

Cinemática directa de los manipuladores 

La cinemática es la ciencia que trata el movimiento sin considerar las fuerzas que lo 
ocasionan. Dentro de la cinemática se estudian la posición, velocidad, aceleración y to¬ 
das las derivadas de mayor orden de las variables de posición (respecto al tiempo o a 


z 



FIGURA 1.5: El sistema de coordenadas o “trama” se adjunta a los manipuladores y a 
los objetos en el ambiente. 
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cualquier otra variable). Por ende, el estudio de la cinemática de los manipuladores 
se refiere a todas las propiedades del movimiento, las geométricas y las basadas en 
tiempo. 

Los manipuladores consisten de vínculos casi rígidos, los cuales están conectados 
por articulaciones que permiten el movimiento relativo de los vínculos adyacentes. Es¬ 
tas articulaciones generalmente se instrumentan con sensores de posición, los cuales 
permiten medir la posición relativa de los vínculos adyacentes. En el caso de las articula¬ 
ciones giratorias o angulares, estos desplazamientos se conocen como ángulos articu¬ 
lados. Algunos manipuladores contienen articulaciones deslizantes (o prismáticas), en las 
que el desplazamiento relativo entre los vínculos es una translación, algunas veces lla¬ 
mada desplazamiento de articulación. 

El número de grados de libertad que posee un manipulador es el número de va¬ 
riables de posición independientes que tendrían que especificarse para poder localizar 
todas las piezas del mecanismo. Este es un término general que se utiliza para cualquier 
mecanismo. Por ejemplo, un vínculo de cuatro barras sólo tiene un grado de libertad 
(incluso aunque haya tres miembros móviles). En el caso de los robots industriales co¬ 
munes, como un manipulador es generalmente una cadena cinemática abierta y como 
la posición de cada articulación se define generalmente con una sola variable, el núme¬ 
ro de articulaciones es igual al número de grados de libertad. 

En el extremo libre de la cadena de vínculos que conforman el manipulador se en¬ 
cuentra el efector final. Dependiendo de la aplicación que se va a dar al robot, el efec- 
tor final podría ser una pinza, un soplete de soldadura, un electroimán o cualquier otro 
dispositivo. Generalmente presentamos la posición del manipulador proporcionando 
una descripción de la trama de la herramienta, la cual está unida al efector final, relati¬ 
va a la trama base, que está unida a la base fija del manipulador. (Vea la figura 1.6). 

Un problema muy básico en el estudio de la manipulación mecánica se conoce co¬ 
mo cinemática directa, que es el problema geométrico estático de calcular la posición y 
orientación del efector final del manipulador. Específicamente, dado un conjunto de 
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FIGURA 1.6: Las ecuaciones cinemáticas describen la trama de la herramienta relativa 
a la trama base como una función de las variables de la articulación. 
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ángulos articulares, el problema de la cinemática directa es calcular la posición y orien¬ 
tación de la trama de la herramienta relativa a la trama base. Imaginemos que es como 
cambiar la representación de la posición del manipulador: de una descripción en el es¬ 
pacio de la articulación a una descripción en el espacio cartesiano . 1 Exploraremos este 
problema en el capítulo 3. 

Cinemática inversa de los manipuladores 

En el capítulo 4 consideraremos el problema de la cinemática inversa. Este problema 
se plantea de la siguiente manera: dada la posición y orientación del efector final del 
manipulador, calcule todos los conjuntos posibles de ángulos articulares que podrían 
utilizarse para obtener esta posición y orientación dadas. (Vea la figura 1.7). Este es un 
problema fundamental en el uso práctico de los manipuladores. 

Este es un problema geométrico algo complicado, que se resuelve de manera ru¬ 
tinaria miles de veces diariamente en el sistema humano y en otros sistemas biológicos. 
En el caso de un sistema artificial como un robot, necesitamos crear un algoritmo en la 
computadora de control que pueda realizar este cálculo. En ciertos casos, la solución 
de este problema es el elemento más importante en un sistema manipulador. 

Podemos pensar en este problema como en una asignación de “ubicaciones” en el 
espacio cartesiano 3D, a “ubicaciones” en el espacio de articulaciones internas del robot. 
Esta necesidad surge naturalmente siempre que se especifica un objetivo en coordenadas 
de espacio 3D externas. Algunos de los primeros robots carecían de este algoritmo; sim¬ 
plemente se desplazaban (algunas veces manualmente) hacia las ubicaciones deseadas, 
que después se registraban como un conjunto de valores de articulación (es decir, como 
una ubicación en el espacio de la articulación) para su posterior reproducción. Obvia¬ 
mente, si el robot se utiliza solamente en el modo de registrar y reproducir las ubicacio¬ 
nes y los movimientos de las articulaciones, no es necesario ningún algoritmo que 



FIGURA 1.7: Para una posición y orientación dadas de la trama de la herramienta, los valo¬ 
res de las variables de una articulación pueden calcularse mediante la cinemática inversa. 

1 Por espacio cartesiano nos referimos al espacio en el que la posición de un punto se da mediante tres 
números, y en donde la orientación de un cuerpo se da también mediante tres números. Algunas veces esto 
se conoce como espacio de trabajo o espacio operacional. 
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relacione el espacio de la articulación con el espacio cartesiano. No obstante, actual¬ 
mente es raro encontrar un robot industrial que carezca de este algoritmo básico de ci¬ 
nemática inversa. 

El problema de la cinemática inversa no es tan simple como el de la cinemática 
directa. Debido a que las ecuaciones cinemáticas son no lineales, su solución no es 
siempre sencilla (o incluso posible) en una forma cerrada. Además, surgen preguntas 
sobre si existe una solución o existen múltiples soluciones. 

El estudio de estas cuestiones hace que apreciemos lo que la mente humana y el 
sistema nervioso logran realizar cuando, al parecer inconscientemente, movemos y ma¬ 
nipulamos objetos con nuestros brazos y manos. 

La existencia o inexistencia de una solución cinemática define el espacio de tra¬ 
bajo de un manipulador dado. La falta de una solución significa que el manipulador no 
puede obtener la posición y orientación deseadas, ya que se encuentran fuera del espa¬ 
cio de trabajo del manipulador. 

Velocidades, fuerzas estáticas, singularidades 

Además de tratar con los problemas de posicionamiento estático, es conveniente ana¬ 
lizar los manipuladores en movimiento. A menudo, al realizar el análisis de velocidad 
de un mecanismo, es conveniente definir una matriz conocida como el jacobiano del 
manipulador. El jacobiano especifica la asignación de las velocidades en espacio de ar¬ 
ticulaciones a las velocidades en espacio cartesiano. (Vea la figura 1.8). La naturaleza 
de esta asignación cambia a medida que varía la configuración del manipulador. En 
ciertos puntos (llamados singularidades), esta asignación no es invertible. Es importan¬ 
te que los diseñadores y usuarios de los manipuladores tengan una comprensión de es¬ 
te fenómeno. 

Considere, como ejemplo, el artillero de la parte trasera de un avión de combate bi¬ 
plano de la Primera Guerra Mundial (mostrado en la figura 1.9). Mientras el piloto dirige 
el avión desde la cabina frontal, el trabajo del artillero en la parte trasera del avión es dis¬ 
parar a las aeronaves enemigas. Para realizar esta tarea, su ametralladora está montada en 
un mecanismo que gira sobre dos ejes; uno de los movimientos se llama acimut y al otro 
elevación. Por medio de estos dos movimientos (dos grados de libertad), el artillero puede 
dirigir su ráfaga de balas en cualquier dirección que desee en el hemisferio superior. 
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FIGURA 1.8: La relación geométrica entre las proporciones de las articulaciones y la 
velocidad del efector final pueden describirse en una matriz conocida como el jacobiano. 
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FIGURA 1.9: Un biplano de la Primera Guerra Mundial con un piloto y un artillero en la 
parte trasera. El mecanismo del artillero en la parte trasera está sujeto al problema de las 
posiciones singulares. 


¡Se detecta un avión enemigo con acimut “a la una en punto” y elevación de 25 
grados! El artillero dirige su ráfaga de balas hacia el avión enemigo y rastrea su movi¬ 
miento para poder pegarle con un flujo continuo de balas el mayor tiempo posible. Lo¬ 
gra tener éxito y en consecuencia derriba el avión enemigo. 

¡Ahora puede verse un segundo avión enemigo con acimut “a la una en punto” y 
elevación de 70 grados! El artillero orienta su ametralladora y empieza a disparar. El 
avión enemigo se mueve para poder obtener una elevación cada vez mayor, relativa al 
avión del artillero. Pronto el avión enemigo está pasando casi encima. ¿Qué es ésto? 
¡El artillero no puede seguir dirigiendo el flujo de balas hacia el avión enemigo! Des¬ 
cubrió que, como el avión enemigo voló por encima, tenía que cambiar su acimut en 
una proporción muy alta. No pudo deslizar su ametralladora con el acimut requerido 
lo suficientemente rápido, por lo que ¡el avión enemigo escapó! 

En este último escenario, ¡el afortunado piloto enemigo se salvó gracias a una sin¬ 
gularidad ! El mecanismo de orientación de la ametralladora, aún y cuando funciona 
bien sobre casi todo su rango de operación, se vuelve menos que ideal cuando la ame¬ 
tralladora se dirige casi o directamente hacia arriba. Para rastrear objetivos que pasan 
a través de la posición directamente encima del avión se requiere de un movimiento 
muy rápido alrededor del eje de acimut. Entre más cerca pase el objetivo del punto que 
está directamente encima del avión, más rápido deberá el artillero girar el eje de aci¬ 
mut para rastrear el objetivo. Si el objetivo vuela directamente sobre la cabeza del ar¬ 
tillero, ¡tendría que girar la ametralladora en su eje de acimut a una velocidad infinita! 

¿Debería quejarse el artillero con el diseñador del mecanismo acerca de este pro¬ 
blema? ¿Podría diseñarse un mejor mecanismo? El caso es que el problema realmente 
no se puede evitar fácilmente. De hecho, cualquier mecanismo de orientación con dos 
grados de libertad que tenga exactamente dos articulaciones giratorias no puede evitar 
este problema. En este caso en especial, cuando se dirige la ráfaga de balas directa¬ 
mente hacia arriba, en línea recta, su dirección se alinea con el eje de rotación del 
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acimut. Esto significa que, en este punto en particular, la rotación del acimut no produ¬ 
ce un cambio en la dirección del flujo de las balas. Sabemos que necesitamos dos gra¬ 
dos de libertad para orientar el flujo de balas pero, en este punto, hemos perdido el uso 
efectivo de una de las articulaciones. Nuestro mecanismo se ha vuelto localmente de¬ 
generado en esta ubicación y se comporta como si solamente tuviera un grado de liber¬ 
tad (la dirección de elevación). 

Este fenómeno se presenta debido a una singularidad del mecanismo. Todos los me¬ 
canismos están sujetos a estas dificultades, incluyendo los robots. Al igual que con el meca¬ 
nismo del artillero de la parte trasera del avión, estas condiciones de singularidad no evitan 
que el brazo de un robot se posicione en cualquier parte dentro de su espacio de trabajo. 
Sin embargo, pueden ocasionar problemas con los movimientos del brazo en su entorno. 

Los manipuladores no siempre se desplazan a través del espacio; algunas veces 
también se requiere que toquen una pieza o superficie de trabajo y que apliquen una 
fuerza estática. En este caso surge el siguiente problema: dada una fuerza y un momen¬ 
to de contacto deseados, ¿qué conjunto de momentos de torsión comunes se requiere 
para generarlas? Una vez más, la matriz jacobiana del manipulador surge muy natural¬ 
mente para la solución de este problema. 

Dinámica 

La dinámica es un enorme campo dedicado al estudio de las fuerzas que se requieren 
para ocasionar el movimiento. Para poder acelerar un manipulador desde una posición 
inerte, deslizarlo a una velocidad constante del efector final y finalmente desacelerarlo 
hasta detenerlo completamente, los actuadores de las articulaciones deben aplicar un 
complejo conjunto de funciones de momento de torsión. 2 La forma exacta de las fun¬ 
ciones requeridas de momento de torsión de un actuador dependen de los atributos es¬ 
paciales y temporales de la ruta tomada por el efector final y de las propiedades de 
masa de los vínculos y de la carga útil; de la fricción en las articulaciones, etcétera. Un 
método para controlar a un manipulador de manera que siga una ruta deseada implica 
calcular estas funciones del momento de torsión del actuador, utilizando las ecuaciones 
dinámicas de movimiento del manipulador. 

Muchos de nosotros hemos experimentado la sensación de levantar un objeto que es 
realmente mucho más ligero de lo que esperábamos (por ejemplo, al levantar un envase 
de leche del refrigerador, del cual pensábamos que estaba lleno, pero realmente estaba ca¬ 
si vacío). Este mal cálculo de la carga útil puede producir un movimiento de levantamien¬ 
to inusual. Este tipo de observación indica que el sistema de control humano es más 
sofisticado que un esquema cinemático puro. Nuestro sistema de control de manipulación 
hace uso del conocimiento de la masa y otros efectos dinámicos. De igual forma, los algo¬ 
ritmos que construimos para controlar el movimiento del manipulador de un robot deben 
tomar en cuenta la dinámica. 

Un segundo uso de las ecuaciones dinámicas del movimiento es la simulación. Al 
reformular las ecuaciones dinámicas, de manera que la aceleración se calcule como una 
función del momento de torsión de un actuador, es posible simular cómo se movería un 
manipulador bajo la aplicación de un conjunto de momentos de torsión de un actuador. 
(Vea la figura 1.10). A medida que el poder computacional se hace más accesible, cre¬ 
ce el uso de las simulaciones y su importancia en muchos campos. 

En el capítulo 6 desarrollaremos ecuaciones dinámicas del movimiento, las cua¬ 
les podrán usarse para controlar o simular el movimiento de los manipuladores. 


2 Utilizamos actuadores de articulaciones como término genérico para los dispositivos que alimentan a un 
manipulador; por ejemplo, los motores eléctricos, los actuadores hidráulicos y neumáticos, y los músculos. 
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FIGURA 1.10: La relación entre los momentos de torsión aplicados por los actuadores y 
el movimiento resultante del manipulador se incorpora en las ecuaciones dinámicas de 
movimiento. 

Generación de trayectorias 

Una manera común de hacer que un manipulador se mueva de aquí para allá, de una 
forma suave y controlada, es hacer que cada articulación se mueva según lo especifica¬ 
do por una función continua del tiempo. Comúnmente, cada articulación inicia y termi¬ 
na su movimiento al mismo tiempo, de manera que el movimiento del manipulador 
parezca coordinado. La manera exacta de calcular estas funciones de movimiento co¬ 
rresponde a la generación de trayectorias. (Vea la figura 1.11). 

A menudo una ruta se describe no solamente mediante un destino deseado, sino 
también mediante algunas ubicaciones intermedias, o puntos vía, a través de los cuales de¬ 
be pasar el manipulador en su ruta hacia su destino. En dichas instancias se utiliza algunas 
veces el término trazador para referirse a una función uniforme que pasa por un conjun¬ 
to de puntos vía. 

Para poder forzar al efector final a que siga una línea recta (o cualquier otra figu¬ 
ra geométrica) a través del espacio, el movimiento deseado debe convertirse a un con¬ 
junto equivalente de movimientos de articulaciones. Esta generación de trayectorias 
cartesianas se considerará también en el capítulo 7. 

Diseño y sensores del manipulador 

Aunque los manipuladores son, en teoría, dispositivos universales que se aplican a mu¬ 
chas situaciones, la economía generalmente dicta que el dominio de la tarea deseada 
ejerce una influencia sobre el diseño mecánico del manipulador. Junto a otras cuestio¬ 
nes como el tamaño, la velocidad y la capacidad de carga, el diseñador debe también 
considerar el número de articulaciones y su arreglo geométrico. Estas consideraciones 
afectan el tamaño y la calidad del espacio de trabajo del manipulador, la rigidez de la 
estructura del manipulador y demás atributos. 

Entre más articulaciones contenga el brazo de un robot, más destreza y capacidad 
tendrá. Desde luego que también será más difícil de construir y más costoso. Para 
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FIGURA 1.11: Para poder mover el efector final a través del espacio, desde el punto A 
hasta el punto B, debemos calcular una trayectoria para que cada articulación la siga. 


poder construir un robot útil, podemos seguir dos enfoques: construir un robot especia¬ 
lizado para una tarea específica o construir un robot universal que pueda realizar una 
amplia variedad de tareas. En el caso de un robot especializado, debemos pensar cui¬ 
dadosamente acerca de cuántas articulaciones se necesitan. Por ejemplo, un robot es¬ 
pecializado diseñado solamente para colocar componentes electrónicos en un tablero 
plano de circuitos no necesita tener más de cuatro articulaciones. Tres de ellas permi¬ 
ten que la mano logre obtener cualquier posición en el espacio tridimensional, y la 
cuarta se agrega para permitir a la mano girar el componente que sujeta sobre un eje 
vertical. En el caso de un robot universal es interesante observar que las propiedades 
fundamentales del mundo físico en el que vivimos son las que indican el número míni¬ 
mo “correcto” de articulaciones; ese número es seis. 

Además del diseño del manipulador están las cuestiones relacionadas con la elec¬ 
ción y ubicación de los actuadores, los sistemas de transmisión y los sensores de posi¬ 
ción interna (y algunas veces de fuerza). (Vea la figura 1.12). Estas y otras cuestiones 
de diseño se explicarán en el capítulo 8. 

Control de posición lineal 

Algunos manipuladores están equipados con motores de pasos o con otros actuadores 
que pueden ejecutar directamente una trayectoria deseada. Sin embargo, la vasta ma¬ 
yoría de los manipuladores se controlan mediante actuadores que suministran una 
fuerza o un momento de torsión para ocasionar el movimiento de los vínculos. En este 
caso se necesita un algoritmo para calcular momentos de torsión que produzcan el mo¬ 
vimiento deseado. Este problema de dinámica es fundamental para el diseño de dichos 
algoritmos, pero no constituye en sí una solución. Algunas de las principales preocupa¬ 
ciones de un sistema de control de posición son compensar automáticamente los errores 
en el conocimiento de los parámetros de un sistema y suprimir los disturbios que tienden 
a desviar al sistema de la trayectoria deseada. Para lograrlo, el algoritmo de control vi¬ 
gila los sensores de posición y velocidad, determinando los comandos de momento de 
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FIGURA 1.12: El diseño de un manipulador mecánico debe considerar la elección del 
actuador, su ubicación, el sistema de transmisión, la rigidez estructural, la ubicación 
del sensor y mucho más. 
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FIGURA 1.13: Para hacer que el manipulador siga la trayectoria deseada, debe imple - 
mentarse un sistema de control de posición que utilice la retroalimentación de los 
sensores de las articulaciones para mantener al manipulador en su curso. 


torsión para los actuadores. (Vea la figura 1.13). En el capítulo 9 consideraremos 
los algoritmos de control cuya síntesis se basa en aproximaciones lineales a la dinámi¬ 
ca de un manipulador. Estos métodos lineales prevalecen actualmente en la práctica 
industrial. 

Control de posición no lineal 

Aunque los sistemas de control basados en los modelos lineales aproximados son po¬ 
pulares en los robots industriales de la actualidad, es importante considerar la dinámi¬ 
ca no lineal completa del manipulador al sintetizar los algoritmos de control. 
Actualmente se están creando algunos robots industriales que utilizan algoritmos de 
control no lineal en sus controladores. Estas técnicas no lineales para controlar un 
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manipulador prometen mejor desempeño que los esquemas lineales más simples. En el 
capítulo 10 presentaremos los sistemas de control no lineales para los manipuladores 
mecánicos. 

Control de la fuerza 

La habilidad de un manipulador para controlar las fuerzas de contacto al tocar piezas, he¬ 
rramientas o superficies de trabajo parece ser de gran importancia al aplicar los manipu¬ 
ladores a muchas tareas del mundo real. El control de la fuerza es complementario al 
control de la posición, ya que generalmente pensamos solamente en uno o en otro para 
aplicarlo en cierta situación. Cuando se mueve un manipulador en el espacio libre sólo el 
control de posición tiene sentido, ya que no hay superficie contra la cual reaccionar. Sin 
embargo, cuando un manipulador está tocando una superficie rígida, los esquemas de 
control de posición pueden ocasionar la acumulación de fuerzas en el contacto, o pueden 
hacer que se pierda el contacto con la superficie cuando precisamente eso era lo que se 
deseaba para alguna aplicación. Los manipuladores raras veces se ven afectados por su¬ 
perficies de reacción en todas las direcciones simultáneamente, por lo que se requiere un 
control mixto o híbrido, en donde algunas direcciones se controlan mediante una ley 
de control de posiciones y las direcciones restantes se controlan mediante una ley de con¬ 
trol de fuerza. (Vea la figura 1.14). En el capítulo 11 presentaremos una metodología pa¬ 
ra implementar dicho esquema de control de fuerza. 

Si queremos indicarle a un robot que lave una ventana manteniendo cierta fuer¬ 
za en la dirección perpendicular al plano del vidrio y que siga una trayectoria de movi¬ 
miento en direcciones tangentes al plano, dichas especificaciones de control dividido o 
híbrido son naturales para estas tareas. 

Programación de robots 

Un lenguaje de programación de robots sirve como interfaz entre el usuario humano y 
el robot industrial. Aquí surgen varias preguntas clave: ¿Cómo describe fácilmente el 



FIGURA 1.14: Para que un manipulador pueda deslizarse a través de una superficie al 
tiempo que aplica una fuerza constante, debe utilizarse un sistema de control híbrido 
de posición-fuerza. 
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FIGURA 1.15: Los movimientos deseados del manipulador y del efector final, las fuerzas 
de contacto deseadas y las estrategias de manipulación complejas pueden describirse 
en un lenguaje de programación de robots. 


programador los movimientos a través del espacio? ¿Cómo se programan varios mani¬ 
puladores de manera que puedan funcionar en paralelo? ¿Cómo se describen las accio¬ 
nes basadas en sensores en un lenguaje? 

Los manipuladores de robots se diferencian a sí mismos de la automatización fi¬ 
ja por ser “flexibles”, lo que significa que son programables. No sólo son programables 
los movimientos de los manipuladores sino que, a través del uso de sensores y comuni¬ 
cación con otros tipos de automatización fabril, los manipuladores pueden adaptarse a 
las variaciones a medida que realizan su tarea. (Vea la figura 1.15). 

En los sistemas de robots comunes hay una manera rápida de que un usuario hu¬ 
mano indique al robot la ruta que debe seguir. En primer lugar, el usuario señala un 
punto especial en la mano (o tal vez en una herramienta que esté sujetando) como el 
punto operacional, al que algunas veces se le conoce también como TCP (punto cen¬ 
tral de herramienta, por sus siglas en inglés). El usuario debe describir los movimien¬ 
tos del robot en términos de ubicaciones deseadas del punto operacional, relativas a un 
sistema de coordenadas especificado por el mismo usuario. Generalmente el usuario 
definirá este sistema de coordenadas de referencia relativo al sistema de coordenadas 
base del robot, en alguna ubicación relevante para la tarea en cuestión. 

Lo más común es que las rutas se construyan mediante la especificación de una 
secuencia de puntos vía. Estos puntos se especifican con relación al sistema de coorde¬ 
nadas de referencia y denotan ubicaciones a lo largo de la ruta a través de la cual debe 
pasar el TCP. Además de especificar los puntos vía, el usuario puede también indicar 
que se utilicen ciertas velocidades del TCP en varias porciones de la ruta. Algunas ve¬ 
ces pueden también especificarse otros modificadores para modificar el movimiento 
del robot (por ejemplo, diferentes criterios de uniformidad, etcétera). Con estas “solu¬ 
ciones” el algoritmo de generación de trayectorias debe planear todos los detalles del 
movimiento: los perfiles de velocidad para las articulaciones, el tiempo de duración 
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del movimiento, etcétera. Por ende, la solución al problema de generación de trayecto¬ 
rias se proporciona generalmente mediante instrucciones en el lenguaje de programa¬ 
ción de robots. 

La sofisticación de la interfaz de usuario se está volviendo extremadamente im¬ 
portante a medida que se usan manipuladores y otro tipo de automatización programa- 
ble en más y más aplicaciones industriales. El problema de programar manipuladores 
abarca todas las cuestiones de la programación computacional “tradicional” y, por con¬ 
secuencia, es en sí un tema extenso. Además, ciertos atributos propios del problema de 
programación de manipuladores hacen que surjan otros contratiempos. Hablaremos 
sobre algunos de estos temas en el capítulo 12. 

Programación fuera de línea y simulación 

Un sistema de programación fuera de línea es un entorno de programación de robots 
que se ha extendido lo suficiente, generalmente mediante gráficos computacionales, 
como para que pueda llevarse a cabo el desarrollo de programas sin la necesidad de ac¬ 
ceder al robot en sí. Un argumento común que ha surgido en favor de estos sistemas es 
que no es necesario detener el equipo de producción (es decir, el robot) para reprogra¬ 
marlo; por lo tanto, las fábricas automatizadas pueden permanecer en modo de produc¬ 
ción una mayor porción del tiempo. (Vea la figura 1.16). 

También sirven como un vehículo natural para enlazar las bases de datos de dise¬ 
ño asistido por computadora (CAD) que se utilizan en la fase de diseño de un produc¬ 
to con la fabricación real del mismo. En algunos casos, el uso directo de datos del CAD 
puede reducir considerablemente el tiempo de programación requerido para el proce¬ 
so de manufactura. En el capítulo 13 hablaremos sobre los elementos de los sistemas 
de programación fuera de línea de robots industriales. 



FIGURA 1.16: Los sistemas de programación fuera de línea, que generalmente propor¬ 
cionan una interfaz de gráficos por computadora, permiten realizar la programación 
del robot sin necesidad de tener acceso al mismo. 
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1.3 NOTACIÓN 

La notación siempre es una cuestión a tratar en la ciencia y la ingeniería. En este libro 
utilizaremos las siguientes convenciones: 

1. Las variables escritas en mayúsculas generalmente representan vectores o matri¬ 
ces. Las variables en minúsculas representan valores escalares. 

2. Los subíndices y superíndices a la izquierda identifican en qué sistema de coorde¬ 
nadas está escrita esa cantidad. Por ejemplo, A P representa un vector de posición 
escrito en el sistema de coordenadas ¡rij, y es una matriz de rotación 3 que es¬ 
pecifica la relación entre los sistemas de coordenadas {A} y \B\. 

3. Los superíndices a la derecha se utilizan (según su amplia aceptación) para indi¬ 
car la inversa o transpuesta de una matriz (por ejemplo, i? -1 , i? 7 ). 

4. Los subíndices a la derecha no están sujetos a ninguna convención estricta, pero 
pueden indicar el componente de un vector (por ejemplo, x,y o z)o pueden usar¬ 
se como una descripción (como en P perno , la posición de un perno). 

5. Utilizaremos muchas funciones trigonométricas. Nuestra notación para el coseno 
de un ángulo 6 X puede tomar cualquiera de las siguientes formas: eos 0 ] = c6 1 — c r 

Los vectores se considerarán como vectores columna; por lo tanto, los vectores fi¬ 
la tendrán la transpuesta indicada explícitamente. 

Una observación sobre la notación de vectores en general: muchos textos de me¬ 
cánica tratan las cantidades vectoriales a un nivel muy abstracto y rutinariamente utili¬ 
zan vectores definidos en relación con distintos sistemas de coordenadas en las 
expresiones. El ejemplo más claro es el de la adición de vectores que se dan o se sabe 
que son relativos a distintos sistemas de referencia. Esto a menudo es muy convenien¬ 
te ya que produce fórmulas compactas y en parte elegantes. Por ejemplo, considere la 
velocidad angular, °co 4 , del último cuerpo en una conexión en serie de cuatro cuerpos 
rígidos (como en los vínculos de un manipulador) relativa a la base fija de la cadena. 
Como las velocidades angulares se suman vectorialmente, podemos escribir una ecua¬ 
ción vectorial muy simple para la velocidad angular del vínculo final: 

°tt>4 = °oq + 1 a>2 + 2 <W 3 + 3 o> 4 . (1.1) 

No obstante y a menos que estas cantidades se expresen respecto a un sistema de coor¬ 
denadas común, no podrán sumarse; por lo tanto, la ecuación (1.1), aunque elegante, 
ha ocultado gran parte del “trabajo” del cálculo. Para el caso específico del estudio de 
los manipuladores mecánicos, ecuaciones como la (1.1) ocultan la tarea de llevar todos los 
detalles relacionados con los sistemas de coordenadas, que a menudo es con lo que ne¬ 
cesitamos tratar en la práctica. 

En consecuencia, en este libro llevaremos la información de marco de referencia 
en la notación para vectores y no debemos sumarlos a menos que se encuentren en el 
mismo sistema de coordenadas. De esta manera podemos derivar expresiones para 
resolver el problema de llevar todos los detalles relacionados con los sistemas de coor¬ 
denadas; además, estas expresiones pueden aplicarse directamente a la computación 
numérica actual. 
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EJERCICIOS 

1.1 [20] Haga una cronología de los principales eventos en el desarrollo de robots industria¬ 
les durante los últimos 40 años. Consulte la bibliografía y las referencias generales. 

1.2 [20] Haga un gráfico que muestre las principales aplicaciones de los robots industria¬ 
les (por ejemplo: soldadura por puntos, ensamblaje, etcétera) y el porcentaje de ro¬ 
bots instalados que se utilizan en cada área de aplicación. Base su gráfico en la 
información más reciente que pueda encontrar. Consulte la bibliografía y las referen¬ 
cias generales. 

1.3 [40] En la figura 1.3 se muestra cómo ha disminuido el costo de los robots industria¬ 
les con el paso de los años. Busque información sobre el costo de la mano de obra hu¬ 
mana en varias industrias específicas (por ejemplo: la mano de obra en la industria 
automotriz, en la industria de ensamblaje de componentes electrónicos, en la agricul¬ 
tura, etcétera) y haga un gráfico que muestre cómo se comparan estos componentes 
con el uso de la robótica. En ese gráfico deberá verse que la curva del costo de los ro¬ 
bots “cruza” varias de las curvas de costo humano de distintas industrias en distintos 
momentos. A partir de esta información, derive las fechas aproximadas del momento 
en que el precio de los robots se hizo rentable para su uso en varias industrias. 
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1.4 [10] Defina en una o dos oraciones, cinemática, espacio de trabajo y trayectoria. 

1.5 [10] Defina en una o dos oraciones estructura, grado de libertad y control de posición. 

1.6 [10] Defina en una o dos oraciones control de fuerza y lenguaje de programación de 
robots. 

1.7 [10] Defina en una o dos oraciones control no lineal y programación fuera de línea. 

1.8 [20] Haga un gráfico que indique cómo han aumentado los costos de la mano de obra 
durante los últimos 20 años. 

1.9 [20] Genere un gráfico que muestre cómo ha aumentado la razón rendimiento-precio 
de las computadoras durante los últimos 20 años. 

1.10 [20] Genere un gráfico que muestre los principales usos de los robots industriales (por 
ejemplo: aeroespacial, automotriz, etc.) y el porcentaje de éstos instalados y en uso en 
cada industria. Base su gráfico en la información más reciente que pueda encontrar. 

EJERCICIO DE PROGRAMACIÓN (PARTE 1) 

Familiarícese con la computadora que utilizará para realizar los ejercicios de programación 
al final de cada capítulo. Asegúrese de poder crear y editar archivos y de poder compilar y 
ejecutar programas. 

EJERCICIO MATLAB 1 

Al final de la mayoría de los capítulos en este libro viene un ejercicio con MATLAB. En ge¬ 
neral, estos ejercicios piden al estudiante que programe la matemática de robótica pertinen¬ 
te en MATLAB y que luego revise los resultados de la Caja de Herramientas de Robótica 
MATLAB (MATLAB Robotics Toolbox). El libro asume que usted está familiarizado con 
MATLAB y el álgebra lineal (teoría de matrices). Además, el estudiante debe familiarizar¬ 
se con la Caja de Herramientas de Robótica MATLAB. Para el ejercicio MATLAB 1: 

a) De ser necesario, familiarícese con el entorno de programación MATLAB. En la inter¬ 
faz de comandos del software MATLAB pruebe a escribir demo y help. Utilizando el 
editor MATLAB con códigos de colores, aprenda a crear, editar, guardar, ejecutar y de¬ 
purar archivos-m (archivos ASCII con series de instrucciones MATLAB). Aprenda a 
crear arreglos (matrices y vectores) y explore las funciones de álgebra lineal de MA¬ 
TLAB para la multiplicación de matrices y vectores, los productos punto y cruz, trans¬ 
puestas, determinantes e inversas, y para la solución de ecuaciones lineales. MATLAB 
se basa en el lenguaje C pero, en general, es mucho más fácil de usar. Aprenda a progra¬ 
mar instrucciones lógicas y ciclos en MATLAB; a utilizar subprogramas y funciones y a 
usar comentarios (%) para explicar sus programas y etiquetas para facilitar la legibili¬ 
dad. Dé un vistazo al sitio www. mathworks.com para obtener más información y tuto- 
riales. Los usuarios avanzados de MATLAB deben familiarizarse con Simulink, la 
interfaz gráfica de MATLAB, y con la Caja de Herramientas Simbólicas de MATLAB. 

b) Familiarícese con la Caja de Herramientas de Robótica MATLAB, un programa con 
herramientas para MATLAB desarrollado por Peter I. Corke de CSIRO, Pinjarra Hills, 
Australia, el cual puede descargar sin costo de www.cat.csiro.au/cmst/staff/pic/robot . 
Puede leer y modificar el código fuente; además, existe una comunidad internacional de 
usuarios con los que puede comunicarse a través de robot-toolbox@lists.msa.cmst.csi- 
ro.au . Descargue la Caja de Herramientas de Robótica MATLAB e instálela en su 
equipo utilizando el archivo .zip y siguiendo las instrucciones. Lea el archivo READ- 
ME y familiarícese con las diversas funciones disponibles para el usuario. Busque el 
archivo robot.pdf\ es el manual del usuario que proporciona información sobre las ba¬ 
ses y el uso detallado de todas las funciones de este software. No se preocupe si no 
puede entender el propósito de estas funciones todavía, ya que muchas se relacionan 
con los conceptos de matemáticas para robots que veremos en los capítulos 2 a 7. 
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2.1 INTRODUCCIÓN 

2.2 DESCRIPCIONES: POSICIONES, ORIENTACIONES Y TRAMAS 

2.3 ASIGNACIONES: CÓMO CAMBIAR DESCRIPCIONES DE TRAMA A TRAMA 

2.4 OPERADORES: TRASLACIONES, ROTACIONES Y TRANSFORMACIONES 

2.5 RESUMEN DE INTERPRETACIONES 

2.6 ARITMÉTICA DE TRANSFORMACIONES 

2.7 ECUACIONES DE TRANSFORMADAS 

2.8 MÁS SOBRE LA REPRESENTACIÓN DE LA ORIENTACIÓN 

2.9 TRANSFORMACIÓN DE VECTORES LIBRES 

2.10 CONSIDERACIONES COMPUTACIONALES 


2.1 INTRODUCCIÓN 

Por definición, la manipulación robótica implica que se desplazarán piezas y herra¬ 
mientas en el espacio mediante algún tipo de mecanismo. Esto naturalmente conduce 
a una necesidad de representar posiciones y orientaciones de piezas, herramientas y del 
mecanismo en sí. Para manipular cantidades mecánicas que representen posición y 
orientación, debemos definir sistemas de coordenadas y desarrollar convenciones para 
la representación. Muchas de las ideas aquí desarrolladas en el contexto de posición y 
orientación formarán una base para nuestra posterior consideración de velocidades li¬ 
neales y angulares, así como de fuerzas y momentos de torsión. 

Adoptaremos la filosofía de que en alguna parte existe un sistema de coordena¬ 
das universal, y que todo lo que hablemos puede hacer referencia a este sistema. Des¬ 
cribiremos todas las posiciones y orientaciones respecto al sistema de coordenadas 
universal o respecto a otros sistemas de coordenadas cartesianas que se definen (o po¬ 
drían definirse) en forma relativa al sistema universal. 

2.2 DESCRIPCIONES: POSICIONES, ORIENTACIONES Y TRAMAS 

Una descripción se utiliza para especificar los atributos de varios objetos con los que 
trata un sistema de manipulación. Estos objetos son piezas, herramientas y el manipu¬ 
lador en sí. En esta sección hablaremos sobre la descripción de posiciones, orientacio¬ 
nes y de una entidad que contiene ambas descripciones: la trama. 
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Descripción de una posición 

Una vez que se establece un sistema de coordenadas, podemos ubicar cualquier punto 
en el universo con un vector de posición de orden 3x1. Como es común que defina¬ 
mos muchos sistemas de coordenadas, además del sistema de coordenadas universal, 
los vectores deben etiquetarse con información que identifique en cuál sistema están 
definidos. En este libro los vectores se escriben con un subíndice a la izquierda que in¬ 
dica el sistema de coordenadas al que hacen referencia (a menos que quede claro, se¬ 
gún el contexto); por ejemplo, A P. Esto significa que los componentes de A P tienen 
valores numéricos que indican distancias sobre los ejes de {A¡. Cada una de estas dis¬ 
tancias sobre un eje puede definirse como el resultado de proyectar el vector sobre el 
eje correspondiente. 

La figura 2.1 representa el dibujo de un sistema de coordenadas llamado ¡Aj, con 
tres vectores unitarios mutuamente ortogonales con puntas sólidas. Un punto A P se re¬ 
presenta como un vector y puede definirse de manera equivalente como una posición 
en el espacio, o simplemente como un conjunto ordenado de tres números. Dados los 
subíndices x,y y z, los elementos individuales de un vector son: 


A P = 



( 2 . 1 ) 


En resumen, describiremos la posición de un punto en el espacio con un vector de po¬ 
sición. Otras descripciones de la posición de puntos en tres dimensiones, como las re¬ 
presentaciones en coordenadas esféricas o cilindricas, se discutirán en los ejercicios al 
final del capítulo. 


Descripción de una orientación 

A menudo necesitamos representar no solamente un punto en el espacio, sino también 
describir la orientación de un cuerpo en el espacio. Por ejemplo, si el vector A P de la fi¬ 
gura 2.2 ubica el punto directamente entre las puntas de los dedos de la mano de un 
manipulador, la ubicación completa de la mano no se especifica sino hasta que se pro¬ 
porciona también su orientación. Suponiendo que el manipulador tiene un número su¬ 
ficiente de articulaciones, 1 la mano podría orientarse arbitrariamente y al mismo 
tiempo podría mantenerse el punto entre las puntas de los dedos en la misma posición 



FIGURA 2.1: Vector relativo a la trama (ejemplo). 


1 En los capítulos 3 y 4 hablaremos sobre cuántas articulaciones son “suficientes”. 







Sección 2.2 Descripciones: posiciones, orientaciones y tramas 21 



FIGURA 2.2: Ubicación de un objeto en posición y orientación. 


en el espacio. Para describir la orientación de un cuerpo, adjuntaremos un sistema de 
coordenadas al cuerpo y luego daremos una descripción de este sistema de coordenadas 
relativo al sistema de referencia. En la figura 2.2 se ha adjuntado el sistema de coorde¬ 
nadas ¡B¡ al cuerpo de una manera conocida. Ahora basta con una descripción de ¡5¡ 
relativo a {Aj para dar la orientación del cuerpo. 

Por ende, las posiciones de los puntos se describen con vectores, y las orientacio¬ 
nes de los cuerpos con un sistema de coordenadas adjunto. Una manera de describir el 
sistema de coordenadas ¡fi¡ adjunto al cuerpo es escribiendo los vectores unitarios de 
sus tres ejes principales 2 en términos del sistema de coordenadas {Aj. 

Para denotar los vectores unitarios proporcionamos las direcciones principales 
del sistema de coordenadas ¡5} como X B , Y B y Z B . Al escribirse en términos del siste¬ 
ma de coordenadas {A¡, se llaman A X B , A Y B y A Z B . Es conveniente si apilamos estos tres 
vectores unitarios como columnas de una matriz de 3 x 3, en el orden A X B , A Y B , A Z B . 
A esta matriz la llamaremos matriz de rotación y, dado que esta matriz de rotación es¬ 
pecífica describe a [5¡ en forma relativa a ¡A), la representamos con la notación ^R (la 
elección de los superíndices y subíndices a la izquierda en la definición de las matrices 
de rotación quedará clara en las siguientes secciones): 


A 

B 


R=[ a X b 



r u 

r 12 

r l3 

r 21 

r 22 

r 23 

r 31 

r 32 

r 33 


( 2 . 2 ) 


En resumen, puede utilizarse un conjunto de tres vectores para especificar una orienta¬ 
ción. A fin de ser más claros, construiremos una matriz de 3 x 3 que tenga estos tres vec¬ 
tores como columnas. En consecuencia, siempre que se represente la posición de un 
punto con un vector, la orientación de un cuerpo se representará con una matriz. En la 


2 A menudo es conveniente utilizar tres, aunque con dos bastaría. (El tercero puede recuperarse toman¬ 
do el producto cruz de los dos ejes dados). 
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sección 2.8 consideraremos otras descripciones de orientación que requieren solamente 
tres parámetros. 

Podemos ofrecer expresiones para los escalares r. en (2.2) teniendo en cuenta que 
los componentes de cualquier vector son simplemente las proyecciones de ese vector en 
las direcciones unitarias de su trama de referencia. Por lo tanto, cada componente de B R 
en (2.2) puede escribirse como el producto punto de un par de vectores unitarios: 


R = [ a x b a y b 


%] = 


X b -*a y b -X a Z b -X a 


x b y a 


Y B ' Y A 


z b -y a 


- x B ■ z A Y B ■ Z A Z B • Z A 


(2.3) 


Por cuestión de brevedad hemos omitido los superíndices a la izquierda de la matriz 
más a la derecha de (2.3). De hecho, la elección de la trama en la cual se van a descri¬ 
bir los vectores unitarios es arbitraria, siempre y cuando sea la misma para cada par que 
se obtenga del producto punto. Como el producto punto de dos vectores unitarios es el 
coseno del ángulo entre ellos, queda claro por qué a los componentes de las matrices 
de rotación se les llama comúnmente cosenos de dirección. 

Una inspección más detallada de (2.3) nos muestra que las filas de la matriz son 
los vectores unitarios de {A} expresados en \B\. es decir, 


A 

B 


r = [ A Xb 



b yr 

ByT 

A 

B¿T 


A J 


(2.4) 


Así, b R , la descripción de la trama {A} relativa a ¡5¡, se da mediante la transpuesta de 
(2.3); esto es, 


B p _ A pT 

a R ~b R ■ 


(2.5) 


Esto sugiere que la inversa de una matriz de rotación es igual a su transpuesta; lo cual 
puede verificarse fácilmente de la siguiente manera 


A R T a R = 


A vT 
X B 
AyT 
B 
A 


[ A X 


B Y B A Z b ] — / 3 , 


( 2 . 6 ) 


Donde / 3 es la matriz identidad 3x3. Por lo que, 


a r = b r -i = Br t (2.7) 

B A A 

En efecto, mediante el álgebra lineal [1], sabemos que el inverso de una matriz 
con columnas ortonormales es igual a su transpuesta. Acabamos de demostrar esto 
geométricamente. 


Descripción de una trama 

La información necesaria para especificar completamente en dónde se encuentra la 
mano del manipulador en la figura 2.2 es una posición y una orientación. El punto en 
el cuerpo cuya posición describimos podría elegirse arbitrariamente. Por conveniencia, el 
punto cuya posición describiremos se elige como el origen de la trama adjunta al cuerpo. 
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La situación de un par posición y orientación surge tan a menudo en robótica que de¬ 
finimos una entidad llamada trama, la cual es un conjunto de cuatro vectores que pro¬ 
porcionan información sobre la posición y la orientación. Por ejemplo, en la figura 2.2 
un vector ubica la posición de la punta de los dedos y tres más describen su orienta¬ 
ción. De manera equivalente, la descripción de una trama puede definirse como un 
vector de posición y una matriz de rotación. Observe que una trama es un sistema de 
coordenadas en donde además de la orientación damos un vector de posición que ubi¬ 
ca su origen de manera relativa a alguna otra trama fija. Por ejemplo, la trama |5j se 
describe mediante ^R y A P BORG , en donde A P BORG es el vector que ubica el origen de 
la trama ¡5): 

{B} = { a b R a P borg }. (2.8) 

En la figura 2.3 hay tres tramas que se muestran junto con el sistema de coordenadas 
universal. Se sabe que las tramas ¡A) y ¡5j son relativas al sistema de coordenadas uni¬ 
versal y que la trama ¡Cj se conoce en relación a la trama ¡zl¡. 

En la figura 2.3 presentamos una representación gráfica de las tramas, lo cual es 
conveniente para visualizarlas. Una trama se describe mediante tres flechas que repre¬ 
sentan vectores unitarios, los cuales definen los ejes principales de la trama. Es necesa¬ 
rio dibujar una flecha que representa a un vector que va de un origen hacia el otro. Este 
vector representa la posición del origen en la punta de la flecha, en términos de la tra¬ 
ma en la cola de la flecha. Por ejemplo, en la figura 2.3, la dirección de esta flecha de 
ubicación nos dice que se sabe que ¡Cj se conoce en términos de |^4¡ y no al revés. 

En resumen, una trama puede utilizarse como una descripción de un sistema de 
coordenadas relativo a otro. Una trama abarca dos ideas al representar tanto la posi¬ 
ción como la orientación, por lo que puede definirse como una generalización de esas 
dos ideas. Las posiciones podrían representarse mediante una trama cuya parte corres¬ 
pondiente a la matriz de rotación es la matriz identidad y cuya parte correspondiente al 
vector de posición ubica el punto que se está describiendo. De igual forma, una orien¬ 
tación podría representarse mediante una trama cuya parte correspondiente al vector 
de posición sea al vector cero. 



FIGURA 2.3: Ejemplo de varias tramas. 
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2.3 ASIGNACIONES: CÓMO CAMBIAR DESCRIPCIONES DE TRAMA A TRAMA 

Gran parte de los problemas de la robótica se refieren a cómo expresar la misma can¬ 
tidad en varios sistemas de coordenadas de referencia. En la sección anterior presenta¬ 
mos descripciones de posiciones, orientaciones y tramas; ahora consideraremos las 
matemáticas de la asignación o mapeo, para poder cambiar las descripciones de una 
trama a otra. 

Asignaciones que involucran tramas trasladadas 

En la figura 2.4 tenemos una posición definida por el vector B P. Deseamos expresar es¬ 
te punto en el espacio en términos de la trama ¡Aj, cuando {Aj tenga la misma orienta¬ 
ción que \B\. En este caso \B\ difiere de {A ¡ sólo por una traslación, que se da mediante 
A BborG' un vect or que ubica el origen de (5¡ relativo a {Aj. 

Como ambos vectores se definen en relación a las tramas de la misma orientación, 
calculamos la descripción del punto P relativo a [A], A P, mediante la suma de vectores: 

A P = B P + A P BO RG- ( 2 - 9 ) 

Observe que sólo en el caso especial de orientaciones equivalentes podemos sumar vec¬ 
tores que estén definidos en términos de tramas diferentes. 

En este ejemplo simple, hemos ilustrado la asignación de un vector de una trama 
a otra. Esta idea de asignar, o cambiar la descripción de una trama a otra, es un concep¬ 
to extremadamente importante. La cantidad en sí (en este caso, un punto en el espa¬ 
cio) no se modifica; sólo se modifica su descripción. Esto se ilustra en la figura 2.4, en 
donde el punto descrito por B P no se traslada sino que permanece igual, y lo que se ha 
hecho es calcular una nueva descripción del mismo punto con respecto al sistema ¡Aj. 



FIGURA 2.4: Asignación de traslación. 
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Decimos que el vector A P BORG define esta asignación porque toda la información 
necesaria para realizar la modificación en la descripción está contenida en A P BORG 
(junto con el conocimiento de que las tramas tenían una orientación equivalente). 


Asignaciones que involucran tramas rotadas 

En la sección 2.2 introdujimos la noción de describir una orientación mediante tres vec¬ 
tores unitarios, denotando los ejes principales de un sistema de coordenadas adjunto a un 
cuerpo. Por conveniencia apilamos estos tres vectores unitarios como columnas de una 
matriz 3 x 3. A esta matriz la llamaremos matriz de rotación y, si esta matriz de rotación 
específica describe a \fí\ en términos de {/I ¡. la identificamos con la notación B R. 

Observe que, según nuestra definición, todas las columnas de una matriz de rota¬ 
ción tienen una magnitud unitaria, además de que estos vectores unitarios son ortogo¬ 
nales. Como vimos antes, una consecuencia de esto es que: 


A 

B 


R = 


b R ~ 1 


b R t . 


( 2 . 10 ) 


Por lo tanto, y como las columnas de B R son los vectores unitarios de ¡5) escritos en 
¡Aj, las filas de B R son los vectores unitarios de (A¡ escritos en \B\. 

De esta manera, una matriz de rotación puede interpretarse como un conjunto de 
tres vectores columna o como un conjunto de tres vectores fila, de la siguiente manera: 


A 

B 


R = [ A X t 



B vT 
X A 
ByT 
A 

B AT 


( 2 . 11 ) 


Como en la figura 2.5, es común que se presente la situación en la que conocemos la 
definición de un vector con respecto a cierta trama, ¡5j, y nos gustaría conocer su defi¬ 
nición con respecto a otra trama, ¡A), en donde los orígenes de las dos tramas sean 


|B| MI 



FIGURA 2.5: Rotación de la descripción de un vector. 
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coincidentes. Este cálculo es posible cuando se conoce una descripción de la orienta¬ 
ción de ¡5) relativa a {A ¡. Esta orientación se representa mediante la matriz de rotación 
A R, cuyas columnas son los vectores unitarios de \B\ escritos en {/l j. 

Para poder calcular A P, hay que tener en cuenta que los componentes de cual¬ 
quier vector son simplemente las proyecciones de ese vector en las direcciones unita¬ 
rias de su trama. La proyección se calcula como el producto punto de los vectores. De 
esta manera, podemos ver que los componentes de A P pueden calcularse como: 



( 2 . 12 ) 


Para poder expresar la ecuación (2.12) en términos de una multiplicación de ma¬ 
trices de rotación, hay que observar en la ecuación (2.11) que las filas de R son B X A , 
B Y 4 y b Z a . Así que la ecuación (2.12) puede escribirse en forma compacta, utilizan¬ 
do una matriz de rotación: 


a P = Ar b p 


(2.13) 


La ecuación (2.13) implementa una asignación; es decir, modifica la descripción de un 
vector: de B P , que describe un punto en el espacio relativo a (5¡, a A P, que es una des¬ 
cripción del mismo punto, pero expresado en forma relativa a ¡A). 

Ahora podemos ver que nuestra notación es de gran ayuda para llevar el registro 
de las asignaciones y las tramas de referencia. Una manera útil de visualizar la notación 
que hemos introducido es imaginar que los subíndices a la izquierda cancelan los supe- 
ríndices a la izquierda de la siguiente entidad, por ejemplo las B en (2.13). 


EJEMPLO 2.1 

La figura 2.6 muestra una trama ¡5) que se gira 30 grados de manera relativa a la tra¬ 
ma {A} sobre Z. Aquí, Z apunta hacia fuera de la página. 



FIGURA 2.6: ¡5j con un giro de 30 grados sobre Z. 





Sección 2.3 Asignaciones: cómo cambiar descripciones de trama a trama 27 

Si escribimos los vectores unitarios de \B\ en términos de ¡A) y los apilamos co¬ 
mo columnas de la matriz de rotación, obtendremos 


Dado que 



0.866 

0.500 

0.000 


-0.500 0.000 
0.866 0.000 
0.000 1.000 


B P = 


0.0 

2.0 

0.0 


calculamos A P como 


a P = a b R b P = 


- 1.000 

1.732 

0.000 


(2.14) 


(2.15) 


(2.16) 


Aquí, b R actúa como una asignación que se utiliza para describir a B P en forma 
relativa a la trama ¡A), A P. Como en el caso de las traslaciones, es importante recor¬ 
dar que, si se ve como una asignación, el vector original P no cambia en el espacio. En 
vez de ello, calculamos una nueva descripción del vector en relación a otra trama. 


Asignaciones que involucran tramas arbitrarias 

Muy a menudo, nos encontramos con una situación en la que conocemos la descripción 
de un vector respecto a cierta trama ¡5¡, y es conveniente conocer su descripción con res¬ 
pecto a otra trama, ¡Aj. Ahora consideraremos el caso general de la asignación. Aquí 
el origen de la trama ¡5) no es coincidente con el de la trama ¡A), sino que tiene un des¬ 
plazamiento vectorial arbitrario. El vector que define el origen de ¡5¡ se llama a P BO rg- 
Además, ¡5¡ se gira con respecto a ¡Aj, según lo describe B R. Dado B P, deseamos 
calcular A P, como en la figura 2.7. 



FIGURA 2.7: Transformada general de un vector. 
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Primero podemos cambiar B P a su descripción relativa a una trama intermedia que 
tiene la misma orientación que [A¡, pero cuyo origen es coincidente con el origen de \fí\. 
Esto se hace multiplicándolo previamente por j] R, como en la última sección. Después 
consideramos la traslación entre orígenes mediante una simple suma vectorial, como an¬ 
tes, y obtenemos: 

A P = A b R B P + A P BO rg ■ (2.17) 

La ecuación (2.17) describe una asignación de transformación general de un vector a 
partir de su descripción en una trama a una descripción en una segunda trama. Obser¬ 
ve la siguiente interpretación de nuestra notación según se muestra en (2.17): las “5” 
se cancelan, dejando todas las cantidades como vectores escritos en términos de “ A ”, 
los cuales pueden ya sumarse sin problema. 

La forma de (2.17) no es tan atractiva como la forma conceptual 

a P = a b T b P. (2.18) 

Esto es, nos gustaría pensar en una asignación de una trama a otra como un operador 
en forma de matriz. Esto nos ayuda a escribir ecuaciones compactas y es conceptual¬ 
mente más claro que (2.17). Para poder escribir las ecuaciones matemáticas dadas en 
(2.17) en la forma de operador matricial sugerida por (2.18), definimos un operador 
matricial de 4 x 4 y utilizamos vectores de posición de 4 x 1, para que (2.18) tenga la 
siguiente estructura: 

- A P ' 

1 

En otras palabras: 

1. Se agrega un “1” como el último elemento de los vectores de 4 x 1. 

2. Se agrega una fila “[000 1]” como la última fila de la matriz de 4 x 4. 

Adoptaremos la convención de que un vector de posición es de 3 x lo4x 1, de¬ 
pendiendo de si se multiplica por una matriz de 3 x 3 o por una de 4 x 4. Puede verse 
de antemano que (2.19) implementa lo siguiente: 

A P = A R B P + A P BO rg 

1 = 1 . ( 2 . 20 ) 

La matriz de 4 x 4 en (2.19) se llama transformada homogénea. Para nuestros fi¬ 
nes, puede tratarse solamente como una construcción utilizada para convertir la rota¬ 
ción y la traslación de la transformada general en una sola forma matricial. En otros 
campos de estudio puede utilizarse para calcular operaciones de perspectiva y escala¬ 
do (cuando la última fila es distinta de “[000 1]” o la matriz de rotación no es ortonor- 
mal). El lector interesado debería consultar [2]. 

Comúnmente escribiremos una ecuación como (2.18) sin ninguna notación que 
indique que es una representación homogénea, ya que esto es obvio debido al contex¬ 
to. Observe que aunque las transformadas homogéneas son útiles para escribir ecuacio¬ 
nes compactas, un programa computacional para transformar vectores generalmente 
no las utilizaría debido al tiempo que se pierde al multiplicar unos y ceros. Por ende, 
esta representación es principalmente para nuestra conveniencia al idear y escribir 
ecuaciones en papel. 


b r 

A p 

r BORG 

0 0 0 

i 


(2.19) 
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Así como utilizamos matrices de rotación para especificar una orientación, utili¬ 
zaremos transformadas (usualmente en representación homogénea) para especificar 
una trama. Observe que aunque hemos introducido transformadas homogéneas en el 
contexto de las asignaciones, también sirven como descripciones de tramas. La descrip¬ 
ción de la trama ¡5) relativa a {A} es g T. 


EJEMPLO 2.2 


La figura 2.8 muestra una trama ¡5} que se gira 30 grados en forma relativa a ¡A) so¬ 
bre Z, se trasladada 10 unidades en X A y 5 unidades en Y A . Encuentre A P en donde 
B P= [3.0 7.0 0.0 ] r . 

La definición de la trama [5] es 


Dada 


T = 


0.866 

-0.500 0.000 

10.0 

0.500 

0.866 0.000 

5.0 

0.000 

0.000 1.000 

0.0 

0 

0 

0 

1 



'3.0" 



B P 

— 

7.0 

, 




0.0 




( 2 . 21 ) 


( 2 . 22 ) 


utilizamos la definición de \B\ que se acaba de dar como una transformación: 


A p _ Aj B p _ 


9.098 

12.562 

0.000 


(2.23) 



FIGURA 2.8: La trama [5¡ girada y trasladada. 
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2.4 OPERADORES: TRASLACIONES, ROTACIONES Y TRANSFORMACIONES 

Las mismas formas matemáticas que se utilizan para correlacionar puntos entre tramas 
pueden interpretarse también como operadores que trasladan puntos, giran vectores o 
hacen ambas cosas. En esta sección ilustraremos esta interpretación de las matemáticas 
que ya hemos desarrollado. 

Operadores de traslación 

Una traslación desliza un punto en el espacio una distancia finita a lo largo de una di¬ 
rección vectorial dada. Con esta interpretación de trasladar el punto en el espacio, só¬ 
lo necesita estar involucrado un sistema de coordenadas. Resulta que el proceso de 
trasladar el punto en el espacio se logra con las mismas matemáticas utilizadas para 
asignar el punto a una segunda trama. Casi siempre es muy importante comprender 
cuál interpretación de las matemáticas se está utilizando. La distinción es tan simple co¬ 
mo esto: cuando un vector se desplaza “hacia adelante” en forma relativa a una trama, 
podemos considerar bien que el vector se desplazó “hacia adelante” o que la trama se 
movió “hacia atrás”. Las matemáticas involucradas en ambos casos son idénticas; sólo 
la manera en que vemos la situación es distinta. La figura 2.9 indica gráficamente cómo 
se traslada un vector A P l mediante un vector A Q. Aquí el vector A Q proporciona la in¬ 
formación necesaria para realizar la traslación. 

El resultado de la operación es un nuevo vector A P, que se calcula así: 

a P 2 = a P 1 + a Q. (2.24) 

Para escribir esta operación de traslación como un operador matricial utilizamos la 
notación: 

A P 2 = D Q {q) A P 1 , (2.25) 

en donde q es la magnitud con signo de la traslación a lo largo de la dirección vectorial 
Q . El operador D Q puede considerarse como una transformada homogénea de una 



FIGURA 2.9: Operador de traslación. 
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forma especialmente simple: 


D Q (q) 


10 0 q x 
0 1 0 q y 
00 1 ?. 
0 0 0 1 


(2.26) 


en donde q x , q v y q_ son los componentes del vector de traslación Qy q — \íq\ + q 2 y + ql 
Las ecuaciones (2.9) y (2.24) implementan las mismas matemáticas. Observe que si hu¬ 
biéramos definido a B P AORG (en vez de A P BORG ) en la figura 2.4 y lo hubiéramos usado 
en (2.9), habríamos visto un cambio de signo entre (2.9) y (2.24). Este cambio de signo 
indicaría la diferencia entre desplazar el vector “hacia adelante” y desplazar el sistema 
de coordenadas “hacia atrás”. Al definir la ubicación de ¡5) en forma relativa a ¡Aj 
(con a P borg )> hacemos que las matemáticas de las dos interpretaciones sean idénticas. 
Ahora que hemos introducido la notación “Dq”, podemos también usarla para descri¬ 
bir tramas y como una asignación. 


Operadores rotacionales 

También se puede interpretar a una matriz de rotación como un operador rotacional 
que opera sobre un vector A P 1 y convierte ese vector en uno nuevo, A por medio de 
una rotación R. Generalmente, cuando una matriz de rotación se muestra como un 
operador, no aparecen subíndices ni superíndices, ya que no se considera que esté re¬ 
lacionando dos tramas. Esto es, podemos escribir 

A P 2 = R A P\. (2.27) 

De nuevo y como en el caso de las traslaciones, los cálculos descritas en (2.13) y en (2.27) 
son las mismas; sólo nuestra interpretación es distinta. Este hecho también nos permite 
ver cómo obtener matrices rotacionales que vayan a utilizarse como operadores: 

La matriz de rotación que gira vectores a través de cierta rotación R, es la misma que 
1a matriz de rotación que describe a una trama girada por R en relación con la trama de re¬ 
ferencia. 

Aunque una matriz de rotación puede verse fácilmente como un operador, tam¬ 
bién definiremos otra notación para un operador rotacional que indica claramente 
sobre qué eje se está girando: 

A P 2 = R K (9) A P 1 . (2.28) 

En esta notación, “R K (9)” es un operador rotacional que realiza una rotación de 9 grados 
sobre la dirección del eje K. Este operador puede escribirse como una transformada ho¬ 
mogénea cuya parte correspondiente al vector de posición sea igual a cero. Por ejemplo, 
si sustituimos en (2.11) se produce el operador que gira 9 grados sobre el eje Z: 


R z {®) = 


eos 9 — sen 0 0 0 
sen0 cosd 0 0 
0 0 10 
0 0 0 1 


(2.29) 


Claro que, para girar un vector de posición, podríamos utilizar también la parte 
correspondiente a la matriz de rotación de orden 3 x 3 de la transformada homogénea. 
Por lo tanto, se puede considerar que la notación U R K ” representa a una matriz de 3 x 3 
o de 4 x 4. Más adelante veremos cómo escribir la matriz de rotación para una rota¬ 
ción sobre un eje £arbitrario. 
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FIGURA 2.10: El vector A P ] girado 30 grados sobre Z. 


EJEMPLO 2.3 

La figura 2.10 muestra un vector A P ] . Deseamos calcular el vector que se obtiene al gi¬ 
rar este vector 30 grados sobre Z. Llamaremos a este nuevo vector A P-,. 

La matriz de rotación que gira los vectores 30 grados sobre Z es la misma que la 
matriz de rotación que describe a una trama que se gira 30 grados sobre Z con respec¬ 
to a la trama de referencia. Por lo tanto, el operador rotacional correcto es 


R z ( 30.0) 


0.866 -0.500 0.000 
0.500 0.866 0.000 

0.000 0.000 1.000 


(2.30) 


Dado 


A Pi = 


0.0 

2.0 

0.0 


(2.31) 


calculamos A P , como 


a P 2 = /?,(30.0) A P y = 


- 1.000 

1.732 

0.000 


(2.32) 


Las ecuaciones (2.13) y (2.27) implementan los mismos cálculos. Si hubiéramos 
definido ¿r (en vez de gR) en (2.13), aparecería entonces el inverso de R en (2.27). 
Este cambio indicaría la diferencia entre girar el vector “hacia adelante” y girar el sis¬ 
tema de coordenadas “hacia atrás”. Al definir la ubicación de ¡5} con respecto a {A} 
(mediante gR), hacemos que los cálculos de las dos interpretaciones sean iguales. 
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Operadores de transformación 

Al igual que con los vectores y las matrices de rotación, una trama tiene otra interpre¬ 
tación como operador de transformación. En esta interpretación sólo se involucra a un 
sistema de coordenadas, por lo que el símbolo T se utiliza sin subíndices ni superíndi- 
ces. El operador T gira y traslada un vector A P 1 para calcular un nuevo vector. 



(2.33) 


De nuevo, como en el caso de las rotaciones, los cálculos descritos en (2.18) y en (2.33) 
son los mismas, sólo nuestra interpretación es distinta. Este hecho también nos permite 
ver cómo obtener transformadas homogéneas que se vayan a utilizar como operadores: 

La transformada que gira mediante R y se traslada mediante Q es la misma que la 
transformada que describe a una trama girada mediante R y trasladada mediante O con 
respecto a la trama de referencia. 

Generalmente se asume que una transformada se encuentra en la forma homogé¬ 
nea con partes generales correspondientes a la matriz de rotación y al vector de posición. 


EJEMPLO 2.4 

La figura 2.11 muestra a un vector A P r Deseamos girarlo 30 grados sobre Z y trasladar¬ 
lo 10 unidades en X A y 5 unidades en Y A . Encuentre A P } , en donde A P ¡ = [3.0 7.0 0.0] r . 
El operador T que realiza la traslación y rotación es 


0.866 -0.500 0.000 10.0 
0.500 0.866 0.000 5.0 

0.000 0.000 1.000 0.0 

0 0 0 1 


(2.34) 


/ 

/ 

/ 


/ 

/ 



/ 

/ 

/ 


/ 


/ 


/ 



FIGURA 2.11: El vector A P l se gira y traslada para formar A P r 
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A Pl = 


3.0 

7.0 

0.0 


(2.35) 


utilizamos T como un operador: 


= T P, = 


9.098 

12.562 

0.000 


(2.36) 


Observe que este ejemplo es, numéricamente idéntico al del ejemplo 2.2, pero la inter¬ 
pretación es bastante distinta. 


2.5 RESUMEN DE INTERPRETACIONES 

Hemos introducido conceptos en cierto orden: primero para el caso de la traslación so¬ 
lamente, después para el caso de la rotación y finalmente para el caso general de rota¬ 
ción sobre un punto y la traslación de ese punto. Después de haber comprendido el 
caso general de rotación y traslación no necesitaremos considerar explícitamente los 
dos casos más simples ya que están contenidos dentro del marco general de trabajo. 

Como herramienta general para representar tramas presentamos la transformada 
homogénea , una matriz de 4 x 4 que contiene información de orientación y posición. 
Hemos introducido tres interpretaciones de esta transformada homogénea: 

1. Es la descripción de una trama. ^ T describe la trama {B} en relación con la trama 
¡Zl}. Específicamente, las columnas de R son vectores unitarios que definen las 
direcciones de los ejes principales de ¡5¡, y A P BORG ubica la posición del origen 
de ¡5j. 

2. Es la asignación de una transformada, T asigna B P —> A P. 

3. Es un operador de transformación. T opera en A P Í para crear A P 1 . 

De aquí en adelante utilizaremos los términos trama y transformada para referir¬ 
nos a un vector de posición más una orientación. Trama es el término preferido al ha¬ 
blar de una descripción, y transformada se utiliza más frecuentemente cuando se 
implica la función como una asignación u operador. Observe que las transformaciones 
son generalizaciones de (e incluyen) traslaciones y rotaciones; a menudo utilizaremos 
el término transformada para hablar de una rotación (o traslación) pura. 

2.6 ARITMÉTICA DE TRANSFORMACIONES 

En esta sección veremos la multiplicación y la inversión de transformadas. Estas dos 
operaciones elementales forman un conjunto funcionalmente completo de operadores 
de transformación. 

Transformaciones compuestas 

En la figura 2.12 tenemos a C P y deseamos encontrar A P. 
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La trama {C¡ se conoce en términos de la trama {B}, y la trama {5¡ se conoce en 
términos de la trama {A ¡. Podemos transformar a C P en B P por medio de 

B P = B T C P; (2.37) 

después podemos transformar B P en A P por medio de 


a P = a T b P. (2.38) 

Si combinamos (2.37) y (2.38) obtendremos el siguiente resultado (definitivamente 
esperado): 


A p A rp B rpC p 

~ B C 

a partir del cual podríamos definir 


A 

C 


T = 


A rpB 
B C ' 


(2.39) 


(2.40) 


De nuevo, observe que la familiaridad con la notación de subíndices y superíndices ha¬ 
ce que estas manipulaciones sean simples. En términos de las descripciones conocidas 
de ¡5¡ y ¡Cj, podemos definir la expresión para (ir como: 


b rB c R 

B R B P CORG + Áp BORG 

0 0 0 

1 


(2.41) 


Invertir una transformada 

Considere una trama ¡S¡ que se conoce con respecto a la trama \A): es decir, conocemos 
el valor de g T. Algunas veces es conveniente invertir esta transformada para obtener una 
descripción de {A} en forma relativa a ¡5¡; es decir, B T. Una manera sencilla de calcular la 
inversa es calculando el inverso de la transformada homogénea de 4 x 4. Pero si hacemos 
esto no estamos aprovechando completamente la estructura inherente en la transforma¬ 
da. Es fácil encontrar un método más sencillo para calcular la inversa, uno que aproveche 
esta estructura. 
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Para encontrar B T debemos calcular B R y B P AORG a partir de r R y de A P BORG - 
Recuerde de nuestra discusión sobre matrices de rotación que 


b r = A R T 


A B 

A continuación cambiamos la descripción de A P 


(2.42) 

borg a ¡ 5 ) utilizando la ecuación (2.13): 


B (A p \ _ B p A p i B p 

^ r BORG) — a K t BORG + *AORG • 

El lado izquierdo de (2.43) debe ser cero, por lo que tenemos que 


(2.43) 




AORG 


= ~ b r a p, 


BORG 


= - a r ta p 


B 


BORG- 


(2.44) 


Utilizando las ecuaciones (2.42) y (2.44), podemos escribir la forma de B T como 


T = 


A nT 

b R 

_ A dT A p 

B K r BORG 

0 0 0 

1 


(2.45) 


Observe que, con nuestra notación, 

B nr A r p — 1 

A B 

La ecuación (2.45) es una manera general y extremadamente útil de calcular la inversa 
de una transformada homogénea. 


EJEMPLO 2.5 

La figura 2.13 muestra una trama ¡5} que se gira 30 grados sobre Z respecto a la trama 
{A} y se traslada cuatro unidades en X A y tres unidades en Y A . De esta manera tenemos 
una descripción de R T. Encuentre B T. 

La trama que define ¡Z?¡ es 



(2.46) 


FIGURA 2.13: ¡5¡ relativa a {A}. 
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Utilizando la ecuación (2.45) calculamos 


B 

A 


T = 


0.866 0.500 0.000 -4.964 
-0.500 0.866 0.000 -0.598 
0.000 0.000 1.000 0.0 
0 0 0 1 


(2.47) 


2.7 ECUACIONES DE TRANSFORMADAS 

La figura 2.14 indica una situación en la que una trama ¡Z)¡ puede expresarse como pro¬ 
ductos de transformaciones en dos formas distintas. Primera forma: 


U r r _ U r f A r j i , 

D ~ A D ’ 


(2.48) 


segunda forma: 


U t _ U r p B ^ C 'T' 

D ~ B C D 


(2.49) 


Podemos hacer que estas dos descripciones de ^ T sean iguales para construir una 

ecuación de transformadas: 


\J ’y A ^ _ U y B y C y 

A D B C D 


(2.50) 



FIGURA 2.14: Conjunto de transformadas que forman un lazo. 
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Las ecuaciones de transformadas pueden usarse para resolver transformadas en el ca¬ 
so de n transformadas desconocidas y n ecuaciones de transformadas. Considere la 
ecuación (2.50) en el caso en que todas las transformadas se conocen, excepto ! ¿ T. Aquí 
tenemos una ecuación de transformadas y una transformada desconocida; por lo tanto, 
podemos encontrar fácilmente su solución: 


B T = u t~ 1 u 
c 1 ~ b 1 A 



(2.51) 


La figura 2.15 indica una situación similar. 

Observe que en todas las figuras hemos introducido una representación gráfica de 
tramas como una flecha que apunta de un origen a otro. La dirección de la flecha indi¬ 
ca de qué manera se definen las tramas. En la figura 2.14 la trama {D} se define en for¬ 
ma relativa a ¡A); en la figura 2.15 la trama {A} se define en forma relativa a [D¡. Para 
poder combinar las tramas al alinearse las flechas, simplemente calculamos el produc¬ 
to de las transformadas. Si una flecha apunta en sentido opuesto en una cadena de 
transformadas, simplemente calculamos primero su inversa. En la figura 2.15, dos po¬ 
sibles descripciones de |C¡ son 


C A A C 


U r j i _ U r j i D ’j '—1 D t 


(2.52) 


y 



(2.53) 



FIGURA 2.15: Ejemplo de una ecuación de transformadas. 
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FIGURA 2.16: Un manipulador tratando de agarrar un perno. 


De nuevo, podríamos igualar las ecuaciones (2.52) y (2.53) para despejar, por decir, ^ T: 


U y _ í/ y B 'T' D y — 1 Z) y 

A B C C A 


(2.54) 


EJEMPLO 2.6 

Suponga que conocemos la transformada 'j T, en la figura 2.16, que describe la trama 
¡rj en la punta de los dedos del manipulador, relativa a su base, ¡5}; que también sabe¬ 
mos en dónde se ubica la parte superior de la mesa en el espacio, relativa a la base del 
manipulador (porque tenemos una descripción de la trama {.S’¡ que está unida a la me¬ 
sa, como se muestra, ®T), y que conocemos la ubicación de la trama unida al perno que 
está sobre la mesa, en forma relativa a la trama de la mesa; es decir, ¡£ T. Calcule la po¬ 
sición y la orientación del perno, de manera relativa a la mano del manipulador, {, T. 

Si nos guiamos por nuestra notación (y esperamos también que por nuestra com¬ 
prensión), calculamos la trama del perno relativa a la trama de la mano como 

= b t -\ b t sy (2.55) 


2.8 MÁS SOBRE LA REPRESENTACIÓN DE LA ORIENTACIÓN 

Hasta ahora nuestro único medio para representar una orientación es mediante una 
matriz de rotación de 3 x 3. Como se ha demostrado, las matrices de rotación son es¬ 
peciales en cuanto a que todas las columnas son mutuamente ortogonales y tienen 
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magnitud unitaria. Además, veremos que el determinante de una matriz de rotación 
siempre es igual a +1. Las matrices de rotación pueden llamarse también matrices or- 
tonormales propias, en donde “propias” se refiere al hecho de que el determinante es 
+1 (las matrices ortonormales impropias tienen el determinante de —1). 

Es natural preguntar si es posible describir una orientación con menos de nueve 
números. Un resultado del álgebra lineal (conocido como fórmula de Cayley para ma¬ 
trices ortonormales [3]) nos dice que, para cualquier matriz ortonormal propia, R , exis¬ 
te una matriz antisimétrica, S, tal que 


R = d 3 -sr 1 (h + s ), 


(2.56) 


en donde /, es una matriz unitaria de 3 x 3. Ahora, una matriz antisimétrica (es decir, S = 
— S 1 ) de dimensión 3 se especifica mediante tres parámetros ($ x , s , .v_) como 


5 = 





(2.57) 


Por lo tanto, una consecuencia inmediata de la fórmula (2.56) es que cualquier matriz 
de rotación de 3 x 3 puede especificarse mediante sólo tres parámetros. 

Evidentemente, no todos los (nueve) elementos de una matriz de rotación son in¬ 
dependientes. De hecho, dada una matriz de rotación, R, es fácil anotar las seis depen¬ 
dencias entre los elementos. Imagine a R como una matriz de tres columnas, como se 
introdujo originalmente: 

Í = [ÍF Z], (2.58) 

Como sabemos por la sección 2.2, estos tres vectores son los ejes unitarios de alguna 
trama, escritos en términos de la trama de referencia. Cada uno es un vector unitario y 
los tres deben ser mutuamente perpendiculares, por lo que podemos ver que hay seis 
restricciones en los nueve elementos de la matriz: 


1*1 = 1 , 
m = i, 

\z\ = 1, (2.59) 

X ■ Y = 0, 

X ■ Z = 0, 

Y ■ Z = 0. 

Es natural preguntar si pueden idearse representaciones de la orientación de manera 
que la representación se especifique convenientemente con tres parámetros. En esta 
sección presentaremos varias representaciones de ese tipo. 

Mientras que las traslaciones sobre tres ejes mutuamente perpendiculares son 
bastante fáciles de visualizar, las rotaciones parecen ser menos intuitivas. Desafortuna¬ 
damente, a la gente se le dificulta describir y especificar orientaciones en espacio tridi¬ 
mensional. Una de las dificultades radica en que las rotaciones generalmente no se 
conmutan. Esto es, j) R ¡.i R no es lo mismo que £R R. 




Sección 2.8 


Más sobre la representación de la orientación 41 


EJEMPLO 2.7 


Considere dos rotaciones, una de 30 grados sobre Z y otra de 30 grados sobre X : 


0.866 -0.500 0.000 


R z { 30) = 0.500 0.866 0.000 

0.000 0.000 1.000 


(2.60) 


1.000 0.000 0.000 


R x (30) = 0.000 0.866 -0.500 

0.000 0.500 0.866 


(2.61) 


0.87 -0.43 0.25 


R Z (30)R X (30) = 0.50 0.75 -0.43 

0.00 0.50 0.87 


0.87 -0.50 0.00 


¿ R X (30)R Z (30) = 0.43 0.75 -0.50 

0.25 0.43 0.87 


(2.62) 


El hecho de que el orden de las rotaciones sea importante no debe sorprender; lo que 
es más, se captura en el hecho de que utilizamos matrices para representar rotaciones, 
ya que la multiplicación de matrices en general no es conmutativa. 


Como las rotaciones pueden considerarse ya sea como operadores o como des¬ 
cripciones de orientación, no es sorprendente que distintas representaciones sean 
preferidas para cada uno de estos usos. Las matrices de rotación son útiles como ope¬ 
radores. Su forma matricial es tal que, cuando se multiplican por un vector, realizan la 
operación de rotación. No obstante, las matrices de rotación son poco manejables cuan¬ 
do se utilizan para especificar una orientación. A un operador humano en una terminal 
de computadora que desee introducir la especificación de la orientación deseada de la 
mano de un robot se le dificultaría mucho introducir una matriz de nueve elementos 
con columnas ortonormales. Sería más simple una representación que requiriera sola¬ 
mente tres números. En las siguientes secciones introduciremos varias de esas repre¬ 
sentaciones. 

Ángulos fijos X - Y - Z 

Un método para describir la orientación de una trama ¡5) es el siguiente: 

Empiece con la trama que sea coincidente con una trama de referencia co¬ 
nocida ¡A). Gire ¡5¡ primero sobre X A usando un ángulo y, luego sobre Y A 
usando un ángulo ¡3 y finalmente sobre Z A usando un ángulo a. 

Cada una de las tres rotaciones se lleva a cabo sobre un eje en la trama de refe¬ 
rencia fija {A}. A esta convención para especificar una orientación la llamaremos ángu¬ 
los fijos X-Y-Z. La palabra “fijos” se refiere al hecho de que las rotaciones se 
especifican sobre la trama de referencia fija (es decir, inmóvil) (figura 2.17). Algunas 
veces esta convención se conoce como ángulos de balanceo, inclinación y orientación 
(en inglés, roll, pitch, yaw), pero hay que tener cuidado ya que a menudo este nombre 
se da a otras convenciones, relacionadas pero distintas. 
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¿A ¿4 



FIGURA 2.17: Ángulos fijos X-Y-Z. Las rotaciones se llevan a cabo en el orden R^y), 

Ry(P), R z (a). 


La derivación de la matriz de rotación equivalente, gR XYZ (y, A °0 es directa, ya 
que todas las rotaciones ocurren sobre ejes de la trama de referencia; esto es: 


A B R XYZ (y, P, a) = R z (a)R Y (p)R x (y) 


ca —sa 0 


c0 0 sp ' 


5a ca 0 


0 1 0 


0 0 1 


—sP 0 cP 



0 

cy 

sy 


0 

-sy 

cy 


(2.63) 


en donde ca es la abreviación de eos a, sa de sen a y así sucesivamente. Es extremada¬ 
mente importante comprender el orden de las rotaciones usadas en la ecuación (2.63). 
Si pensamos en términos de las rotaciones como si fueran operadores, hemos aplicado 
las rotaciones (a partir de la derecha) de R x (y), después R Y (f>) y luego R z (a). Después 
de realizar la multiplicación en (2.63) obtenemos 


b R xyz(Y’ A “) 


cac/3 cas/3sy — sacy cas/3cy + sasy 
sac/3 sasfísy + cacy sasficy — casy 
—s¡6 efisy cjicy 


(2.64) 


Recuerde que la definición dada aquí especifica el orden de las tres rotaciones. La 
ecuación (2.64) es correcta sólo para las rotaciones realizadas en el siguiente orden: y 
grados sobre X A , p grados sobre Y A , a grados sobre Z A . 

El problema inverso, el de extraer los ángulos fijos X-Y-Z equivalentes a partir de 
una matriz de rotación, es a menudo de interés. La solución depende de resolver un 
conjunto de ecuaciones trascendentales: hay nueve ecuaciones y tres incógnitas si (2.64) 
se iguala a una matriz de rotación dada. Entre las nueve ecuaciones hay seis depen¬ 
dencias, por lo que, esencialmente, tenemos tres ecuaciones y tres incógnitas. Supon¬ 
gamos que 


A 

B 



'‘ti 

r 12 

r 13 

r xyz(Y ’ A °0 — 

r 2l 

r 22 

r 23 


_ r 31 

r 32 

r 33 _ 


(2.65) 


De la ecuación (2.64) podemos ver que, al sacar la raíz cuadrada de la suma de los 
cuadrados de r n y r 21 , podemos calcular eos /i Después podemos resolver para /i con 
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el arco tangente de — r 31 sobre el coseno calculado. Luego, siempre y cuando cp ^ 0, po¬ 
demos resolver para a sacando el arco tangente de r 21 lc¡6 sobre r n lc¡B y podemos resol¬ 
ver para y sacando el arco tangente de r 32 /cjS sobre r 33 /c/i. 

En resumen: 


P = Atan2(—r 31 , -t-r^), 

a = Atan2(r 21 /c/3, r n /cP), (2.66) 

y — Atan2 (r 32 /cP, r 33 /cP), 

en donde Atan2(y, x) es una función arco tangente de dos argumentos. 3 

Aunque existe una segunda solución, al utilizar la raíz cuadrada negativa en la 
fórmula para p siempre calculamos la única solución para la cual —90.0° < p <, 90.0°. Es¬ 
to es recomendable ya que podemos definir funciones de asignación de uno a uno 
entre varias representaciones de la orientación. No obstante, en algunos casos es im¬ 
portante calcular todas las soluciones (profundizaremos en este tema en el capítulo 4). 

Si p — ±90.0° (para que cp = 0), la solución de (2.66) se degenera. En esos casos 
sólo puede calcularse la suma o diferencia de a y y. Una posible convención es elegir a 
= 0 en estos casos, lo cual nos da los resultados que se muestran a continuación. 

Si p — 90.0°, puede calcularse una solución para que 

P = 90.0°, 

a = 0.0, (2.67) 

y = Atan20 12 , r 22 ). 

Si p — —90.0°, puede calcularse una solución para que 

p = -90.0°, 

a = 0.0, (2.68) 

y —— —Atan2(r 12 , r 22 ). 


Ángulos de Euler Z - Y - X 

Otra posible descripción de una trama ¡fi¡ podría ser la siguiente: 

Comience con la trama que sea coincidente con una trama ¡A¡ conocida. Gi¬ 
re ¡5¡ primero sobre Z /( usando un ángulo a, después sobre Y B usando un 
ángulo p, y finalmente sobre X B usando un ángulo y. 

En esta representación, cada rotación se lleva a cabo sobre un eje del sistema ¡5j 
móvil, en lugar de hacerlo sobre uno de la referencia fija |A¡. Dichos conjuntos de tres 


3 Atan2(_y, x) calcula tan -1 (j) pero utiliza los signos tanto de x como de y para identificar el cuadrante 
en el que se encuentra el ángulo resultante. Por ejemplo, Atan2(—2.0, —2.0) = —135°, mientras que Atan2(2.0, 
2.0) = 45°, una distinción que se perdería con una función arco tangente de un solo argumento. 
Frecuentemente estamos calculando ángulos que pueden variar sobre un giro completo de 360°, por lo que 
utilizaremos comúnmente la función Atan2. Observe que Atan2 se vuelve indefinida cuando ambos argu¬ 
mentos son iguales a cero. Algunas veces se le llama “arco tangente de 4 cuadrantes” y algunas bibliotecas de 
lenguajes de programación la tienen predefinida. 
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FIGURA 2.18: Ángulos Z-Y-X de Euler. 


rotaciones se llaman ángulos de Euler. Observe que cada rotación se lleva a cabo sobre 
un eje cuya ubicación depende de las rotaciones anteriores. Como las tres rotaciones 
ocurren sobre los ejes Z, Yy X, llamaremos a esta representación ángulos de Euler Z- 
Y-X. 

La figura 2.18 muestra los ejes de ¡5} después de aplicar cada rotación por un án¬ 
gulo de Euler. La rotación a sobre Z ocasiona que X gire hacia X', que Y gire hacia Y’ 
y así sucesivamente. Se agrega una “prima” adicional a cada eje con cada rotación. Una 
matriz de rotación que esté parametrizada por ángulos de Euler Z-Y-X se indicará me¬ 
diante la notación gR z , Y , x ,(a, ft. y). Observe que hemos agregado “primas” a los subín¬ 
dices para indicar que esta rotación es descrita por ángulos de Euler. 

Con referencia a la figura 2.18, podemos usar las tramas intermedias ¡5'¡ y [B") 
para poder obtener una expresión para ^R z , rx ,(a, y). Pensando en las rotaciones co¬ 
mo las descripciones de estas tramas, podemos escribir inmediatamente 

A B R = A B ,R B B „R B B 'R, (2.69) 

en donde cada una de las descripciones relativas en el lado derecho de (2.69) se da por 
el enunciado de la convención del ángulo de Euler Z-Y-X. En sí, la orientación final de 
¡5¡ se da en forma relativa a {A} como 

fj R 7,’Y'X' = 


ca —sa 0 


c/3 0 s/3~ 


'10 0 " 

sa ca 0 


0 1 0 


0 cy —sy 

0 0 1 


-si6 0 c/3 


0 sy cy 


en donde ca = eos a, sa = sen a, y así sucesivamente. Al multiplicar obtenemos 


^Rz'y'x'^ 01 ' P'Y) 


cac/3 cas/3sy — soicy casfícy +sasy 
sac/3 sasfísy + cacy sasfícy — casy 
— s/3 efisy cfícy 


(2.71) 


Observe que el resultado es exactamente el mismo que se obtiene para las mismas tres 
rotaciones que se realizan en el orden opuesto sobre ejes fijos. Este no muy intuitivo 
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resultado tiene validez general: tres rotaciones realizadas sobre tres ejes fijos producen 
igual orientación final que las mismas tres rotaciones realizadas en orden opuesto so¬ 
bre los ejes de la trama móvil. 

Como la ecuación (2.71) es equivalente a la ecuación (2.64), no hay necesidad de 
repetir la solución para extraer ángulos de Euler Z-Y-X a partir de una matriz de rota¬ 
ción. Esto es, la ecuación (2.66) puede usarse también para resolver ángulos de Euler 
Z-Y-X que correspondan a una matriz de rotación dada. 


Ángulos de Euler Z-Y-Z 

Otra posible descripción de una trama ¡5j es 

Empiece con la trama que sea coincidente con una trama {Aj conocida. Gi¬ 
re ¡Z?¡ primero sobre Z B usando un ángulo a, después sobre Y B usando un 
ángulo p y, finalmente, sobre Z b con un ángulo y. 

Las rotaciones se describen en forma relativa a la trama que estamos moviendo, 
en este caso ¡5), por lo que ésta es una descripción de ángulo de Euler. Como las tres 
rotaciones ocurren sobre los ejes Z, Y y Z, llamaremos a esta representación ángulos 
de Euler Z-Y-Z 

Siguiendo exactamente el mismo desarrollo que en la sección anterior, llegamos 
a la matriz de rotación equivalente 


B R Z'Y'Z'( a > P' Y) 


cacPcy — sasy —cacPsy — sacy casfi 
sacficy+casy —sctcfisy + cacy sasfi 
—sftcy sfisy cP 


(2.72) 


La solución para extraer ángulos Z-Y-Z de Euler a partir de una matriz de rota¬ 
ción se da a continuación. 

Dada: 


g^z'y'z'(“' P' Y) 


r n 

r 12 

r 13 

r 21 

r 22 

r 23 

r 31 

r 32 

r 33 _ 


Entonces, si sen 0, resulta que 

p = Atan2( x /r 3 2 1 + r\ v r 33 ), 


a — Atan2(r 23 /.?/í, r 13 /sP), 


y = Atan2(r 32 /íyS, -r 3í /sP). 


(2.73) 


(2.74) 


Aunque existe una segunda solución (que encontramos utilizando la raíz cuadrada ne¬ 
gativa en la fórmula para p), siempre calculamos la única solución para la cual 0.0° < p 
< 180.0°. Si P — 0.0 o 180.0°, la solución de (2.74) se degenera. En esos casos sólo pue¬ 
de calcularse la suma o la diferencia de a y de y. Una posible convención es elegir a — 
0.0 en estos casos, lo cual nos da los siguientes resultados. 

Si p = 0.0, entonces puede calcularse una solución para que 


P = 0.0, 

a = 0 . 0 , 

y = Atan2(—r 12 , r n ). 


(2.75) 
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Si p — 180.0°, entonces puede calcularse una solución para que 

P = 180.0°, 

a = 0.0, (2.76) 

y = Atan2(r 12 , — r^). 


Otras convenciones de fijación de ángulos 

En las subsecciones anteriores hemos visto tres convenciones para especificar la orien¬ 
tación: ángulos fijos X-Y-Z, ángulos de Euler Z-Y-X y ángulos de Euler Z-Y-Z. Cada 
una de estas convenciones requiere de la realización de tres rotaciones sobre los ejes 
principales en un cierto orden y son ejemplos de un conjunto de 24 convenciones que 
llamaremos convenciones de fijación de ángulos. De éstas, 12 son para conjuntos de án¬ 
gulos fijos y 12 para conjuntos de ángulos de Euler. Observe que, debido a la dualidad 
de los conjuntos de ángulos fijos con los conjuntos de ángulos de Euler, realmente hay 
sólo 12 parametrizaciones únicas de una matriz de rotación utilizando rotaciones suce¬ 
sivas sobre los ejes principales. A menudo no hay una razón específica para preferir 
una convención sobre otra, pero como varios autores adoptan distintas convenciones 
es útil tener una lista de las matrices de rotación equivalentes para las 24 convenciones. 
En el apéndice B de este libro se proporcionan las matrices de rotación equivalentes 
para las 24 convenciones. 


Representación de ángulo-eje equivalente 

Con la notación 7? x (30.0) damos la descripción de una orientación al proporcionar un 
eje Xy un ángulo de 30.0 grados, que es un ejemplo de una representación de ángulo- 
eje equivalente. Si el eje es una dirección general (en vez de una de las direcciones uni¬ 
tarias) puede obtenerse cualquier orientación a través de la selección apropiada de eje 
y ángulo. Considere la siguiente descripción de una trama ¡B¡: 

Empiece con la trama que sea coincidente con una trama ¡Aj conocida; des¬ 
pués gire ¡Z?j sobre el vector ^Xusando un ángulo 6 de acuerdo con la regla 
de la mano derecha. 


Al vector Xalgunas veces se le llama eje equivalente de una rotación finita. Una 
orientación general de ¡Bj relativa a |A¡ puede escribirse como gR(K, 6) o R K (0) y se 
le llama representación de ángulo-eje equivalente. 4 La especificación del vector A K 
requiere sólo de dos parámetros, ya que su longitud siempre se considera como igual 
a uno. El ángulo especifica un tercer parámetro. A menudo multiplicamos la direc¬ 
ción unitaria, K, con la cantidad de rotación, 6, para formar una descripción de orien¬ 
tación mediante un vector compacto de 3 x 1, denotado por K (sin “gorro”). Vea la 
figura 2.19. 

Cuando se selecciona el eje de rotación de entre los ejes principales de ¡A), la ma¬ 
triz de rotación equivalente toma la forma familiar de rotaciones planares: 


R x (8) 


1 1 0 
0 eos 6 — sen# 
0 sen# eos# 


(2.77) 


4 El que existan Ky 6 para cualquier orientación de |5| relativa a filj lo demostró originalmente Euler; a 
esto se le conoce como Teorema de Euler sobre rotación [3]. 
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FIGURA 2.19: Representación de ángulo-eje equivalente. 


Ry(0) 


R z (0) 


eos 9 0 send 
0 10 
— sen 9 0 eos 0 

eos 9 — sen 9 0 
sen 9 eos 9 0 
0 0 1 


(2.78) 

(2.79) 


Si el eje de rotación es un eje arbitrario, puede mostrarse (como en el ejercicio 2.6) que 
la matriz de rotación equivalente es 


R k (0) 


k x k x v9 + c9 k x k y v9 — k z s9 k x k : v9 + k y s9 
k x k Y vO + k,s9 k y k y v0 + c9 k x k,v9 — k x s9 
k x k.v9 — k.,s9 k'k,v9 + k x s9 k„k,v9 + c6 

a <, y y 2 , -*• 4-c 


(2.80) 


en donde cQ = eos 9, s9 = sen 9, v9 = 1 — eos 9 y A K— [k x k y k z ] T . El signo de 9 se deter¬ 
mina mediante la regla de la mano derecha, en donde el pulgar apunta hacia el sentido 
positivo de A K. 

La ecuación (2.80) convierte de representación de ángulo-eje a representación de 
matriz de rotación. Observe que, dado cualquier eje de rotación y cualquier cantidad 
angular, podemos construir fácilmente una matriz de rotación equivalente. 

El problema inverso de calcular Ky 9 a partir de una matriz de rotación dada se 
deja en su mayor parte para los ejercicios (ejercicios 2.6 y 2.7), aunque enseguida mos¬ 
tramos un resultado parcial [3]. Si 


entonces 


\R k W) 


r ll r 12 r 13 
r 21 r 22 r 23 > 

r 31 r 32 r 33 _ 


(2.81) 


( r ll + r22 + r 33 ~ 


6 — Acos 


2 
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y 


K = 


1 

2 sen 6 


r 32 _ r 23 
r 13 _ r 31 
r 2l ~ r 12 _ 


(2.82) 


Esta solución siempre calcula un valor de 6 entre 0 y 180 grados. Para cualquier par de 
ángulo-eje ( A K, 6) hay otro par (— A K. —0) que resulta en la misma orientación en el es¬ 
pacio y lo describe la misma matriz de rotación. Por lo tanto, al convertir de una ma¬ 
triz de rotación en una representación de ángulo-eje, nos encontramos con que 
tenemos que elegir una de varias soluciones. Un problema más grave es que, para ro¬ 
taciones angulares pequeñas, el eje se vuelve mal definido. Evidentemente, si la canti¬ 
dad de rotación se vuelve cero, el eje de rotación se vuelve completamente indefinido. 
La solución dada por la ecuación (2.82) falla si 6 — 0 o o si 0 = 180°. 


EJEMPLO 2.8 

Una trama ¡5) se describe como inicialmente coincidente con [A¡. Después giramos \B\ 
sobre el vector A K — [0.707 0.707 0.0 ] T (pasando a través del origen) usando un ángu¬ 
lo 6 — 30 grados. Proporcione la descripción de la trama [5¡. 

Al sustituir en (2.80) se produce la parte relacionada con la matriz de rotación de 
la descripción de la trama. No hubo traslación del origen, por lo que el vector de posi¬ 
ción es [0, 0, 0] T . Por lo tanto, 


0.933 

0.067 

0.354 

0.0 

0.067 

0.933 

-0.354 

0.0 

-0.354 

0.354 

0.866 

0.0 

0.0 

0.0 

0.0 

1.0 


(2.83) 


Hasta este punto, todas las rotaciones que hemos visto han sido sobre ejes que pa¬ 
san a través del origen del sistema de referencia. Si encontramos un problema para el 
que esto no sea cierto, podemos reducir el problema al caso del “eje a través del ori¬ 
gen” definiendo tramas adicionales cuyos orígenes estén sobre el eje y luego resolvien¬ 
do una ecuación de transformadas. 


EJEMPLO 2.9 

Una trama \B\ se describe como inicialmente coincidente con [A]. Después giramos \B\ 
sobre el vector A K — [0.707 0.707 0.0 ] T (pasando por el punto A P = [1.0 2.0 3.0]) usan¬ 
do un ángulo 6 — 30 grados. Proporcione la descripción de la trama \B\. 

Antes de la rotación, [A] y [5] son coincidentes. Como se muestra en la figura 
2.20, definimos dos nuevas tramas {A'} y [5'¡, las cuales son coincidentes entre sí y tie¬ 
nen la misma orientación que [A] y {£] respectivamente, pero se trasladan en forma 
relativa a [A] por un desplazamiento que coloca sus orígenes en el eje de rotación. Se¬ 
leccionaremos 


A 

A' 


T = 


1.0 0.0 0.0 1.0 
0.0 1.0 0.0 2.0 
0.0 0.0 1.0 3.0 
0.0 0.0 0.0 1.0 


(2.84) 
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FIGURA 2.20: Rotación sobre un eje que no pasa a través del origen de {/I j. Inicialmente 
¡5) era coincidente con ¡A). 


De manera similar, la descripción de ¡R¡ en términos de \B '¡ es: 


1.0 

O 

o 

o 

o 

-1.0 

p 

O 

1.0 

o 

o 

-2.0 

O 

O 

O 

o 

1.0 

-3.0 

O 

O 

o 

o 

o 

o 

1.0 


(2.85) 


Ahora, si mantenemos las otras relaciones fijas, podemos girar ¡Z?'¡ con respecto a {A'}. 
Ésta es una rotación sobre un eje que pasa a través del origen, por lo que podemos usar 
(2.80) para calcular {B'} relativa a {A'}. Al sustituir en (2.80) se produce la parte corres¬ 
pondiente a la matriz de rotación de la descripción de la trama. No hubo traslación del 
origen, por lo que el vector de posición es [0, 0, 0] r . Por lo tanto, tenemos que 


A' 


T = 


la cual se evalúa en 


\T = 


0.933 0.067 

0.354 

0.0 " 

0.067 0.933 

-0.354 

0.0 

-0.354 0.354 

0.866 

0.0 

0.0 

0.0 

0.0 

1.0 

a ecuación transformada 

para 

A r r _ 

A T A' j 

B' t 


B ~ 

A' B' 

B 1 ’ 


0.933 

0.067 

0.354 - 

-1.13 

0.067 

0.933 - 

-0.354 

1.13 

-0.354 

0.354 

0.866 

0.05 

0.000 

0.000 

0.000 

1.00 


( 2 . 86 ) 


(2.87) 


( 2 . 88 ) 


Una rotación sobre un eje que no pasa a través del origen ocasiona un cambio en la 
posición, además de la misma orientación final, como si el eje hubiera pasado a tra¬ 
vés del origen. 












50 Capítulo 2 


Descripciones espaciales y transformaciones 


Observe que podríamos haber usado cualquier definición de {A'} y \fí’\ tal que sus orí¬ 
genes estuvieran en el eje de rotación. Nuestra elección particular de orientación fue 
arbitraria, y nuestra elección de la posición del origen fue una entre una infinidad de 
posibles elecciones que están sobre el eje de rotación. (Vea también el ejercicio 2.14). 


Parámetros de Euler 

Otra representación de la orientación es mediante cuatro números conocidos como los 
parámetros de Euler. Aunque su completa discusión está más allá del alcance de este 
libro, mencionaremos aquí la convención como referencia. 

En términos del eje equivalente K— [k x k y k^ T y del ángulo equivalente 9, los pa¬ 
rámetros de Euler se dan de la siguiente manera: 

. o 

O = K sen 2> 

e 2 = k y sen (2.89) 

9 

e 3 = k z sen-, 

9 

e 4 = eos-. 

Queda claro que estas cuatro cantidades no son independientes: 


4 + 4 + 4 + 4 =1 (Z90) 

siempre debe cumplirse. Por lo tanto, una orientación podría visualizarse como un pun¬ 
to en una hiperesfera unitaria en un espacio de cuatro dimensiones. 

Algunas veces los parámetros de Euler se ven como un vector de 3 x 1 más un es¬ 
calar. No obstante, como un vector de 4 x 1 los parámetros de Euler se conocen como 

un cuaternión unitario. 

La matriz de rotación R ( que es equivalente a un conjunto de parámetros de 
Euler es: 


R* = 


1 


2f 2 


2e 2 

3 


e 3 e 4) 


2( e l e 2 "b e 3 e 4) 
2(00 ~ e 2 e 4 ) 


2(e í e 2 - 
1 - 2e 2 
2(e 2 e 3 + 6464) 


*4 


2(6163 + 6 2 6 4 ) 
2(e 2 e 3 — e!e 4 ) 

1 - 2e ? - 2f 2 J 


(2.91) 


Dada una matriz de rotación, los parámetros de Euler equivalentes son: 


^ _ r 32 ~ r 23 

1 46 4 

, _ r 13 ~ r 31 

2 46 4 

r 21 ~ r 12 


(2.92) 


e 4 — 2 \/l + r \\ + r 22 + r 33 . 
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Observe que la ecuación (2.92) no es útil en un sentido computacional si la matriz de 
rotación representa una rotación de 180 grados sobre cierto eje, ya que e 4 tiende a cero. 
No obstante puede demostrarse que en el límite todas las expresiones en (2.92) siguen 
siendo finitas, incluso para este caso. De hecho, por las definiciones de la ecuación 
(2.89) está claro que todas las e ¡ permanecen en el intervalo [—1,1]. 

Orientaciones enseñadas y predefinidas 

En muchos sistemas de robots será posible “enseñar” posiciones y orientaciones utili¬ 
zando el mismo robot. El manipulador se desplaza a una ubicación deseada y se regis¬ 
tra esta posición. Una trama enseñada de esta manera no necesariamente tiene que ser 
una a la que se haga regresar al robot; podría ser la ubicación de una pieza o de un dis¬ 
positivo. En otras palabras, el robot se utiliza como herramienta de medición que tie¬ 
ne seis grados de libertad. Enseñar una orientación como ésta elimina por completo 
la necesidad de que el programador humano tenga que tratar con la representación de la 
orientación. En la computadora, el punto enseñado se almacena como una matriz de 
rotación (o de cualquier otra forma), pero el usuario no tiene que verlo ni entenderlo. 
Por lo tanto, se recomiendan ampliamente los sistemas de robots que permiten la en¬ 
señanza de tramas mediante el uso del mismo robot. 

Además de enseñar tramas, algunos sistemas tienen un conjunto de orientaciones 
predefinidas, tales como “apuntar hacia abajo” o “apuntar a la izquierda”. Para los hu¬ 
manos es muy fácil tratar con estas especificaciones. No obstante, si éste fuera el único 
medio para describir y especificar la orientación, el sistema estaría muy limitado. 

2.9 TRANSFORMACIÓN DE VECTORES LIBRES 

En este capítulo nos hemos preocupado principalmente por los vectores de posición. En 
capítulos posteriores hablaremos también de los vectores de velocidad y fuerza. Estos 
vectores se transformarán de manera distinta, ya que son un tipo diferente de vector. 

En mecánica se hace la distinción entre la igualdad y la equivalencia de vectores. 
Dos vectores son iguales si tienen las mismas dimensiones, magnitud y dirección. Dos 
vectores que se consideran iguales podrían tener distintas líneas de acción; por ejem¬ 
plo, los tres vectores iguales de la figura 2.21. Estos vectores de velocidad tienen las 
mismas dimensiones, magnitud y dirección, y por lo tanto son iguales de acuerdo con 
nuestra definición. 

Dos vectores son equivalentes en cierta capacidad si cada uno produce el mismo 
efecto en esa capacidad. Por lo tanto, si el criterio en la figura 2.21 es la distancia recorri¬ 
da, los tres vectores dan el mismo resultado y son, por lo tanto, equivalentes en esta ca¬ 
pacidad. Si el criterio es la altura por encima del plano xy, entonces los vectores no son 
equivalentes a pesar de su igualdad. Por ende, las relaciones entre vectores y las nocio¬ 
nes de equivalencia dependen completamente de la situación que esté ocurriendo. Lo que 
es más, vectores que no son iguales podrían causar efectos equivalentes en ciertos casos. 

Enseguida definiremos dos clases básicas de cantidades vectoriales que podrían 
ser útiles. 

El término vector línea se refiere a un vector que es dependiente de su línea de 
acción, junto con la dirección y la magnitud, para ocasionar sus efectos. A menudo los 
efectos de un vector de fuerza dependen de su línea de acción (o punto de aplicación), 
por lo que entonces se consideraría como un vector línea. 

Un vector libre se refiere a un vector que puede posicionarse en cualquier parte 
en el espacio sin perder ni cambiar su significado, teniendo en cuenta que se preserven 
su magnitud y dirección. 
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FIGURA 2.21: Vectores con igual velocidad. 

Por ejemplo, un vector de momento puro es siempre un vector libre. Si tenemos 
un vector de momento B N que se conoce en términos de \B\. entonces calculamos el 
mismo momento en términos de la trama ¡A¡ como 

a N = a b R b N. (2.93) 

En otras palabras, todo lo que cuenta es la magnitud y la dirección (en el caso de un 
vector libre), por lo que sólo se utiliza la matriz de rotación que relaciona a los dos sis¬ 
temas en la transformación. Las ubicaciones relativas de los orígenes no entran en el 
cálculo. 

De igual forma, un vector de velocidad escrito en ¡5¡, B V, se escribe en {A} como 

a V = a R b V. (2.94) 

La velocidad de un punto es un vector libre, por lo que todo lo que importa es su direc¬ 
ción y su magnitud. La operación de rotación, como en la ecuación (2.94), no afecta a 
la magnitud, pero logra la rotación que cambia la descripción del vector de ¡S¡ a {A}. 
Observe que A P BORG , que aparecería en una transformación de vector de posición, no 
aparece en una transformada de velocidad. Por ejemplo, en la figura 2.22, si B V = 5X, 
entonces A V = 5Y. 

Los vectores de velocidad y fuerza, junto con los vectores de momento, se presen¬ 
tarán con más detalle en el capítulo 5. 

2.10 CONSIDERACIONES COMPUTACIONALES 

La disponibilidad de poder computacional de bajo costo es en gran parte responsable 
del crecimiento de la industria de la robótica; a pesar de ello, y por mucho tiempo toda¬ 
vía, la computación eficiente seguirá siendo una cuestión importante en el diseño de un 
sistema de manipulación. 

La representación homogénea es útil como entidad conceptual, pero el software 
de transformación que se utiliza comúnmente en los sistemas de manipulación indus¬ 
triales no hace uso de ella directamente, ya que el tiempo que se invierte multiplicando 
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por ceros y unos es un desperdicio. Generalmente, se realizan los cálculos que se mues¬ 
tran en las ecuaciones (2.41) y (2.45), en lugar de la multiplicación directa o inversión 
de matrices de 4 x 4. 

El orden en el que se aplican las transformaciones puede hacer una gran diferen¬ 
cia en la cantidad de cómputo requerido para calcular la misma cantidad. Considere el 
proceso de realizar múltiples rotaciones de un vector, como en 


A P = A R b c r c d r d P. 


(2.95) 


Una opción es multiplicar primero las tres matrices de rotación para formar ^ R en 
la expresión 


a P = a d R d P. (2.96) 

Para formar a partir de sus tres constituyente se requieren 54 multiplicaciones y 36 
sumas. Para realizar la multiplicación final de matriz-vector de la ecuación (2.96) se re¬ 
quieren 9 multiplicaciones y 6 sumas adicionales, lo que nos lleva a un total de 63 mul¬ 
tiplicaciones y 42 sumas. 

Si en lugar de eso transformamos el vector a través de las matrices, una a la vez, 
esto es: 


A p = a r b r c d r D p 

a P = a R b R c P (2.97) 

B C 

a p = a r b p 

A p A p 

entonces el cálculo total requiere solamente 27 multiplicaciones y 18 sumas; menos de 
la mitad de los cálculos requeridos por el otro método. 

Claro que, en ciertos casos, las relaciones B R, B R y £ R son constantes, mientras 
que hay muchos D P ¡ que necesitan transformarse en A P ¡ . En tal caso, es más eficiente 
calcular A ) R de una vez y luego usarlo para todas las asignaciones futuras. Vea también 
el ejercicio 2.16. 
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EJEMPLO 2.10 

Proporcione un método para calcular el producto de dos matrices de rotación, B R B R, 
que utilice menos de 27 multiplicaciones y 18 sumas. 

Si L¡ representa a las columnas de B R y C¡ representa las tres columnas del resul¬ 
tado, calcule 


¿i 

C 2 


A 

B 

A 

B 


RL 


i > 


RL 2. 


C^ — C i x C, 


(2.98) 


que requiere 24 multiplicaciones y 15 sumas. 
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EJERCICIOS 

2.1 [15] Un vector A P se gira 0 grados sobre Z A y se gira subsecuentemente 0 grados so¬ 
bre X A . Proporcione la matriz de rotación que realice estas rotaciones en el orden 
dado. 

2.2 [15] Un vector A P se gira 30 grados sobre Y A y subsecuentemente otros 45 grados 
sobre Jt A . Proporcione la matriz de rotación que realice estas rotaciones en el or¬ 
den dado. 

2.3 [16] Una trama { B } se encuentra inicialmente coincidente con una trama {A}. Giramos 
{ B ] 0 grados sobre Z B y luego giramos la trama resultante 0 grados sobre X R . Propor¬ 
cione la matriz de rotación que cambie las descripciones de los vectores de B P a A P. 

2.4 [16] Una trama { B } se encuentra inicialmente coincidente con una trama {A}. Giramos 
[B] 30 grados sobre Z B y luego giramos la trama resultante 45 grados sobre X B . Pro¬ 
porcione la matriz de rotación que cambie la descripción de los vectores de B P a A P. 

2.5 [13] b R es una matriz de 3 x 3 con los valores propios 1, e +m y e~ al ; en donde i = A/—1. 
¿Cuál es el significado físico del vector propio de B R asociado con el valor propio 1? 

2.6 [21] Derive la ecuación (2.80). 

2.7 [24] Describa (o programe) un algoritmo que extraiga el ángulo equivalente y el eje 
de una matriz de rotación. La ecuación (2.82) es un buen comienzo, pero asegúrese 
que su algoritmo maneje los casos especiales 9 = 0 o y 9 = 180°. 
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2.8 [29] Escriba una subrutina que cambie la representación de la orientación de la for¬ 
ma matriz de rotación a la forma ángulo-eje equivalente. La declaración de un proce¬ 
dimiento estilo Pascal empezaría así: 

Procedure MRAAE (VAR R:mat33; VAR K:vec3; VAR theta: real); 


Escriba otra subrutina que cambie de la representación de ángulo-eje equivalente a la 
representación de matriz de rotación: 

Procedure AEAMR(VAR K:vec3; VAR theta: real; VAR R:mat33); 


Escriba las rutinas en C si lo prefiere. 

Ejecute estos procedimientos en varios casos de datos de prueba extensivamente y ve¬ 
rifique que obtenga lo que introdujo. Incluya algunos de los casos difíciles. 

2.9 [27] Haga el ejercicio 2.8 para ángulos de balanceo, inclinación y orientación sobre 
ejes fijos. 

2.10 [27] Haga el ejercicio 2.8 para ángulos de EulerZ-Y-Z. 

2.11 [10] ¿Bajo qué condición se conmutan dos matrices de rotación que representan rota¬ 
ciones finitas? No se requiere una prueba. 

2.12 [14] Un vector de velocidad se da de la siguiente forma: 


B V 


10.0 

20.0 

30.0 


Dada 

Ay _ 

B ~ 


0.866 -0.500 0.000 11.0 “ 
0.500 0.866 0.000 -3.0 

0.000 0.000 1.000 9.0 

0 0 0 1 


calcule A V. 

2.13 [21] Las siguientes definiciones de trama se dan como conocidas: 


- 0.866 

-0.500 

0.000 

íi.o- 


0.500 

0.866 

0.000 - 

-1.0 


0.000 

0.000 

1.000 

8.0 

’ 

_0 

0 

0 

1 


- 1.000 

0.000 

0.000 

0.0 

1 

0.000 

0.866 - 

-0.500 

10.0 


0.000 

0.500 

0.866 - 

-20.0 


_0 

0 

0 

1 

- 

- 0.866 

-0.500 

0.000 

-3.0 


0.433 

0.750 

-0.500 

-3.0 

0.250 

0.433 

0.866 

3.0 

_0 

0 

0 

1 



Dibuje un diagrama de tramas (como el de la figura 2.15) para mostrar su arreglo cua¬ 
litativamente y resuelva para ^ T. 

2.14 [31] Desarrolle una fórmula general para obtener gT en donde, empezando por la 
coincidencia inicial, [B] se gire 0 grados sobre K. cuando lepase por el punto A P (no 
a través del origen de [A]). 

2.15 [34] {A} y [B] son tramas que difieren sólo en su orientación. {B} se obtiene de la si¬ 
guiente manera: empezando en forma coincidente con [A], [B] se gira 6 radianes so¬ 
bre el vector unitario K, esto es, 

b R = A b R k(0). 
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A 

B 


R 


= e 


ke 


0 -k x ky 



2.16 [22] Un vector debe asignarse a través de tres matrices de rotación: 

A p = a r b c r c d r D p. 

Una opción es multiplicar primero las tres matrices de rotación juntas para formar j] R 
en la expresión 


Otra opción es transformar el vector a través de las matrices, una a la vez; esto es, 

A p = a r b r c d r D p , 

Ap = b R c R Cp ’ 

A P = A b R B P , 

A p _ A p 

Si D P está cambiando a 100 Hz, tendríamos que recalcular A P a la misma proporción. No 
obstante, las tres matrices de rotación también están cambiando, según lo reportado por 
un sistema de visión que nos da nuevos valores para B R, B R y ( n R a 30 Hz. ¿Cuál es la 
mejor manera de organizar el cómputo para minimizar el esfuerzo de cálculo (multipli¬ 
caciones y sumas)? 

2.17 [16] Otro conjunto familiar de tres coordenadas que puede utilizarse para describir un 
punto en el espacio son las coordenadas cilindricas. Las tres coordenadas se definen 
como se muestra en la figura 2.23. La coordenada 8 proporciona una dirección en el 
plano xy sobre el cual se realiza la traslación radialmente con base en una cantidad r. 
Finalmente se da z para especificar la altura sobre el plano xy. Calcule las coordena¬ 
das cartesianas del punto A P en términos de las coordenadas cilindricas 6>, ry z. 

2.18 [18] Otro conjunto de tres coordenadas que puede usarse para describir un punto en 
el espacio son las coordenadas esféricas. Las tres coordenadas se definen según se 
muestra en la figura 2.24. Se puede considerar que los ángulos ay fi describen el aci¬ 
mut y la elevación de un rayo que se proyecta en el espacio. La tercera coordenada 
(r) es la distancia radial sobre ese rayo hasta el punto que se está describiendo. 
Calcule las coordenadas cartesianas del punto A P en términos de las coordenadas es¬ 
féricas a, fi y r. 

2.19 [24] Un objeto se gira una cantidad de </> grados sobre su eje Xy después se gira una 
cantidad de 'F sobre su nuevo eje De nuestro estudio de los ángulos de Eulcr sabe¬ 
mos que la orientación resultante se da mediante 


R x (4>)R y W), 

mientras que, si las dos rotaciones hubieran ocurrido sobre ejes de la trama de refe¬ 
rencia fija, el resultado hubiera sido 

R y iir)R x (</>). 
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FIGURA 2.23: Coordenadas cilindricas. 



FIGURA 2.24: Coordenadas esféricas. 


Parece que el orden de multiplicación depende de si las rotaciones se describen en for¬ 
ma relativa a los ejes fijos o a los de la trama que se está moviendo. No obstante, es más 
apropiado tener en cuenta que en caso de especificar una rotación sobre un eje de la tra¬ 
ma que se está moviendo, estamos especificando una rotación en el sistema fijo que (en 
este ejemplo) está dado por: 


RzMRyWR- 1 ^). 

Esta transformada de similitud [1], que multiplica a la R x {<p) de la izquierda, se reduce a 
la expresión resultante en la cual se ve como si se hubiera invertido el orden de mul¬ 
tiplicación de las matrices. Tomando este punto de vista, proporcione una derivación 
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para la forma de la matriz de rotación que sea equivalente al conjunto de ángulos 
de Eulcr Z-Y-X (a , fi, y). El resultado se da mediante la ecuación (2.72). 

2.20 [20] Imagine que se gira un vector Q sobre un vector K una cantidad de 6 grados pa¬ 
ra formar un nuevo vector, Q'\ esto es, 

Q' = R k (9)Q- 

Use la ecuación (2.80) para derivar la fórmula de Rodrigues: 

Q' = Qcosd + senO(K x Q) + (1 - cos0)(X • Q)K. 

2.21 [15] Para rotaciones que sean suficientemente pequeñas como para que las aproxima¬ 
ciones sen 6=6 , eos 6 = 1, y 6 2 = 0 sean siempre ciertas, derive la matriz de rotación 
equivalente a una rotación de 6 sobre un eje general, K. Empiece con la ecuación (2.80) 
para su derivación. 

2.22 [20] Usando el resultado del ejercicio 2.21, muestre que dos rotaciones infinitesimales 
conmutan (es decir, el orden en el que se realizan las rotaciones no es importante). 

2.23 [25] Proporcione un algoritmo para construir la definición de una trama U Á T a partir 
de tres puntos U P V U P 2 y u P y en donde se conoce lo siguiente sobre estos puntos: 

1. % se encuentra en el origen de [A]. 

2. % se encuentra en alguna parte del eje ^positivo de [A]. 

3. se encuentra cerca del eje ^positivo, en el plano XY de {A}. 

2.24 [45] Demuestre la fórmula de Cayley para matrices ortonormales propias. 

2.25 [30] Muestre que los valores propios de una matriz de rotación son 1, e al y e~ al , en don¬ 
de i = —1. 

2.26 [33] Demuestre que cualquier conjunto de ángulos de Euler es suficiente para expre¬ 
sar todas las posibles matrices de rotación. 

2.27 [15] Tomando como referencia la figura 2.25, proporcione el valor de 7’. 

2.28 [15] Tomando como referencia la figura 2.25, proporcione el valor de 

2.29 [15] Tomando como referencia la figura 2.25, proporcione el valor de ® T. 

2.30 [15] Tomando como referencia la figura 2.25, proporcione el valor de T. 

2.31 [15] Tomando como referencia la figura 2.26, proporcione el valor de )] 7’. 



3 


FIGURA 2.25: Tramas en las esquinas de una cuña. 
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2.32 

2.33 

2.34 

2.35 

2.36 


2.37 


2.38 


2.39 


2.40 


2.41 



r- 3 -H 

FIGURA 2.26: Tramas en las esquinas de una cuña. 


[15] Tomando como referencia la figura 2.26, proporcione el valor de '1 T. 

[15] Tomando como referencia la figura 2.26, proporcione el valor de ^ T. 

[15] Tomando como referencia la figura 2.26, proporcione el valor de ^ T. 

[20] Demuestre que el determinante de cualquier matriz de rotación es siempre igual a 1. 
[36] Un cuerpo rígido que se desplaza en un plano (por ejemplo, en espacio 2D) tiene 
tres grados de libertad. Un cuerpo rígido que se desplaza en espacio 3D tiene seis grados 
de libertad. Muestre que un cuerpo en espacio ^/-dimensional tiene y(/V 2 + N) gra¬ 
dos de libertad. 


[15] Dada 



- 0.25 0.43 

0.87 -0.50 
0.43 0.75 

.0 0 


0.86 5.0 - 

0.00 -4.0 
-0.50 3.0 

0 1 


¿cuál es el elemento (2, 4) de % TI 

[25] Imagine dos vectores unitarios, v 1 y v 2 , incrustados en un cuerpo rígido. Tenga en 
cuenta que, sin importar cómo se gire el cuerpo, el ángulo geométrico entre estos dos 
vectores se preserva (es decir, la rotación de un cuerpo rígido es una operación de “pre¬ 
servación de ángulo”). Use este hecho para proporcionar una prueba concisa (de cua¬ 
tro o cinco líneas) de que la inversa de una matriz de rotación debe ser igual a su 
transpuesta, y de que una matriz de rotación es ortonormal. 

[37] Proporcione un algoritmo (tal vez en forma de programa en C) que calcule el cua- 
ternión unitario que corresponda a una matriz de rotación dada. Utilice (2.91) como 
punto de inicio. 

[33] Proporcione un algoritmo (tal vez en forma de un programa en C) que calcule los 
ángulos de Euler Z-X-Z que correspondan a una matriz de rotación dada. Vea el 
apéndice B. 

[33] Proporcione un algoritmo (tal vez en forma de un programa en C) que calcule los 
ángulos fijos X-Y-X que correspondan a una matriz de rotación dada. Vea el apéndice B. 


EJERCICIO DE PROGRAMACIÓN (PARTE 2) 

1. Si su biblioteca de funciones no incluye una subrutina de función Atan2, escriba una. 

2. Para hacer una interfaz de usuario amigable, deseamos describir la orientación en el 
mundo planar mediante un solo ángulo 8, en vez de utilizar una matriz de rotación de 
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Capítulo 2 


Descripciones espaciales y transformaciones 


2 x 2. El usuario siempre se comunicará en términos del ángulo 9, pero internamen¬ 
te necesitaremos la forma de la matriz de rotación. Para la parte correspondiente al 
vector de posición de una trama, el usuario especificará un valor para x y uno para y. 
Por lo tanto, queremos permitir al usuario que especifique a la trama como una tría¬ 
da: (x, y, 9). Internamente deseamos usar un vector de posición de 2 x 1 y una matriz 
de rotación de 2 x 2, por lo que necesitamos rutinas de conversión. Escriba una ruti¬ 
na cuya definición en Pascal empiece así: 

Procedure UAI (VAR formau: vec3; VAR formai: trama); 
en donde “UAI “ significa “formato de Usuario A formato Interno”. El primer argu¬ 
mento es la tríada (x, y, 0) y el segundo argumento es de tipo “trama”, el cual consis¬ 
te en un vector de posición (2 x 1) y una matriz de rotación (2 x 2). Si lo desea, puede 
representar la trama con una transformada homogénea (3 x 3) en la que la tercera fi¬ 
la sea [0 0 1], También será necesaria la rutina inversa: 

Procedure IAU (VAR formai: trama; VAR formau: vec3); 

3. Escriba una subrutina para multiplicar dos transformadas. Use el siguiente encabeza¬ 
do de procedimiento: 

Procedure TMULT (VAR brela, crelb, creía: trama); 

Los primeros dos argumentos son entradas y el tercero es salida. Observe que los 
nombres de los argumentos documentan lo que hace el programa (brela = ^T). 

4. Escriba una subrutina para invertir una transformada. Use el siguiente encabezado de 
procedimiento: 

Procedure TINVERT (VAR brela, arelb: trama); 

El primer argumento es la entrada, el segundo la salida. Observe que los nombres de 
los argumentos documentan lo que hace el programa (brela = ^T). 

5. Las siguientes definiciones de tramas se dan como conocidas: 

u a T = [xy0] = [11.0 - 1.0 30.0], 
b a T = \x y 6 \ = [0.0 7.0 45.0], 

= [x y 6] = [-3.0 - 3.0 - 30.0], 

Estas tramas se introducen en la representación del usuario [x, y , 9] (en donde 6 se da 
en grados). Dibuje un diagrama de tramas (como el de la figura 2.15, sólo que en 2D) 
que muestre cualitativamente su arreglo. Escriba un programa que llame a TMULT y 
TINVERT (definidas en los ejercicios de programación 3 y 4) todas las veces necesa¬ 
rias para resolver para ^ T. Después imprima ® T tanto en representación interna co¬ 
mo del usuario. 

EJERCICIO MATLAB 2A 

a) Utilizando la convención de ángulos de Eulcr Z-Y-X {oí — p — y), escriba un progra¬ 
ma MATLAB para calcular la matriz de rotación j) K cuando el usuario introduzca los 
ángulos de Euler a — p — y. Haga la prueba en dos ejemplos: 

i) a =10°, P = 20°, y =30°. 

iii) a = 30°, p = 90°, y = -55°. 

Para el caso (i) demuestre las seis restricciones para matrices de rotación ortonorma- 
les unitarias (hay nueve números en una matriz de 3 x 3, pero sólo tres son indepen¬ 
dientes). Además, demuestre la hermosa propiedad, A R = gR' 1 = R T , para el caso i. 
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b) Escriba un programa MATLAB para calcular los ángulos a — p — y de Euler cuando 
el usuario introduzca la matriz de rotación B K (el problema inverso). Calcule las dos 
soluciones posibles. Demuestre esta solución inversa para los dos casos de la parte (a). 
Use una comprobación circular para verificar sus resultados (es decir, introduzca los 
ángulos de Euler en el código a de la parte (a); tome la matriz de rotación B R resul¬ 
tante y utilícela como entrada para el código b\ obtendrá dos conjuntos de respuestas: 
una debe ser la entrada original del usuario y la otra puede verificarse una vez más 
utilizando el código en la parte (a). 

c) Para una rotación simple de p sobre el eje Y solamente, para p = 20° y B P = ¡1 0 l} r , 
calcule A P\ demuestre con un bosquejo que sus resultados son correctos. 

d) Compruebe todos los resultados mediante la Caja de Herramientas de Robótica 
MATLAB de Corke. Pruebe las funciones rpy2tr{), rotx{ ), roty(') y rotzQ. 

EJERCICIO MATLAB 2B 

a) Escriba un programa MATLAB para calcular la matriz de transformación homogénea 
g T cuando el usuario introduzca los ángulos Z-Y-X de Euler a — f> — y y el vector de 
posición a P b . Haga la prueba en dos ejemplos: 

i) a = 10°, 0 = 20°, y = 30° y A P B = {12 3} r . 

ii) Para p = 20° (a = y = 0 o ), A P B = {3 0 l} r . 

b) Para p = 20° {a = y = 0 o ), A P H = {3 0 1 ¡ 7 y n P = {I 0 1 ¡ 7 , utilice MATLAB para calcu¬ 
lar A P\ demuestre con un bosquejo que sus resultados son correctos. Además, utilizando 
los mismos números demuestre las tres interpretaciones de la matriz de transforma¬ 
ción homogénea; la asignación (b) es la segunda interpretación, asignación de trans¬ 
formadas. 

c) Escriba un programa MATLAB para calcular la matriz de transformación homogé¬ 
nea inversa gT 1 = ¿T, utilizando la fórmula simbólica. Compare su resultado con 
una función MATLAB numérica (por ejemplo, inv). Demuestre que ambos métodos 
producen resultados correctos (es decir, que B T B T~ l = B T~ l B T = / 4 ). Demuéstrelo 
para los ejemplos (i) y (iii) del inciso (a) anterior. 

d) Defina B T para que sea el resultado de (a)(i) y que ^ T sea el resultado de (a)(ii). 

i) Calcule A T y muestre la relación mediante un gráfico de transformadas. Haga lo 
mismo para C A T. 

ii) Dadas A T y ¿T de (d)(i), suponga que no conoce B T, calcúlela y compare su re¬ 
sultado con la respuesta que conoce. 

iü) Dadas A T y B T de (d)(i), suponga que no conoce ^ T, calcúlela y compare su re¬ 
sultado con la respuesta que conoce. 

e) Compruebe todos los resultados mediante la Caja de Herramientas de Robótica 
MATLAB de Corke. Pruebe las funciones rpy2tr{) y transl{). 
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3.8 TRAMAS CON NOMBRES ESTÁNDAR 

3.9 ¿EN DÓNDE ESTÁ LA HERRAMIENTA? 

3.10 CONSIDERACIONES COMPUTACIONALES 


3.1 INTRODUCCIÓN 

La cinemática es la ciencia del movimiento que trata el tema sin considerar las fuerzas 
que lo ocasionan. Dentro de esta ciencia se estudian la posición, la velocidad, la acele¬ 
ración y todas las demás derivadas de alto orden de las variables de posición (con res¬ 
pecto al tiempo o a cualquier otra variable). En consecuencia, el estudio de la 
cinemática de manipuladores se refiere a todas las propiedades geométricas y basadas 
en el tiempo del movimiento. Las relaciones entre estos movimientos y las fuerzas y 
momentos de torsión que los ocasionan constituyen el problema de la dinámica, que es 
el tema del capítulo 6. 

En este capítulo consideramos la posición y la orientación de los vínculos de los 
manipuladores en situaciones estáticas. En los capítulos 5 y 6 consideraremos la cinemá¬ 
tica cuando hay velocidades y aceleraciones implicadas. 

Para entender la compleja geometría de un manipulador, agregaremos tramas a 
las diversas partes del mecanismo y luego describiremos las relaciones entre estas tra¬ 
mas. El estudio de la cinemática de manipuladores se relaciona, entre otras cosas, con 
la manera en que cambian las ubicaciones de estas tramas a medida que se articula el 
mecanismo. El tema central de este capítulo es un método para calcular la posición y la 
orientación del efector final del manipulador relativo a la base del mismo, como una 
función de las variables de las articulaciones. 

3.2 DESCRIPCIÓN DE VÍNCULOS 

Un manipulador puede considerarse como un conjunto de cuerpos conectados en una ca¬ 
dena mediante articulaciones. Estos cuerpos se llaman vínculos o segmentos. Las articu¬ 
laciones forman una conexión entre un par adyacente de vínculos. El término par menor 
se utiliza para describir la conexión entre un par de cuerpos, cuando el movimiento 
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relativo se caracteriza por dos superficies que se deslizan una sobre otra. La figura 3.1 
muestra las seis posibles articulaciones de par menor. 

Las consideraciones de diseño mecánico recomiendan que los manipuladores se 
construyan generalmente de articulaciones que exhiban sólo un grado de libertad. La 
mayoría de los manipuladores tienen articulaciones angulares o articulaciones deslizan¬ 
tes llamadas articulaciones prismáticas. En el extraño caso de que un mecanismo esté 
construido con una articulación que tenga n grados de libertad, puede modelarse como 
n articulaciones de un grado de libertad, conectadas con n — 1 vínculos de longitud ce¬ 
ro. Por lo tanto, y sin perder la generalidad, consideraremos sólo manipuladores que 
tengan articulaciones con un solo grado de libertad. 

Los vínculos se numeran empezando desde la base inmóvil del brazo, a la cual po¬ 
dríamos llamar vínculo 0. El primer cuerpo móvil es el vínculo 1 y así, sucesivamente, 
hasta llegar al extremo libre del brazo, el cual es el vínculo n. Para poder posicionar un 
efector final en espacio 3D de forma general se requiere un mínimo de seis articulacio¬ 
nes. 1 Los manipuladores comunes tienen cinco o seis articulaciones. Algunos robots no 
son realmente tan simples como una cadena cinemática abierta; tienen una configura¬ 
ción de paralelogramo u otras estructuras cinemáticas cerradas. Consideraremos uno 
de esos manipuladores más adelante en este capítulo. 

Un solo vínculo de un robot común tiene muchos atributos que el ingeniero me¬ 
cánico tuvo que considerar durante su diseño: el tipo de material empleado, la fuerza y 


1 Esto tiene buen sentido intuitivo, ya que la descripción de un objeto en el espacio requiere seis pará¬ 
metros: tres para la posición y tres para la orientación. 
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Eje i — 1 Eje i 



FIGURA 3.2: La función cinemática de un vínculo es mantener una relación fija entre los 
dos ejes de articulación que soporta. Esta relación puede describirse con dos paráme¬ 
tros: la longitud del vínculo, a, y su ángulo de torsión, a. 

rigidez del vínculo, la ubicación y el tipo de los cojinetes de articulación, la forma ex¬ 
terna, el peso y la inercia, y otros más. Sin embargo, cuando se desean obtener las ecua¬ 
ciones cinemáticas del mecanismo, un vínculo se considera solamente como un cuerpo 
rígido que define la relación entre dos ejes de articulaciones adyacentes de un manipula¬ 
dor. Los ejes de articulación se definen mediante líneas en el espacio. El eje de articu¬ 
lación i se define mediante una línea en el espacio, o la dirección de un vector, sobre el 
cual gira el vínculo i con respecto al vínculo i — 1. Resulta que, para los fines cinemáti¬ 
cos, un vínculo puede especificarse con dos números, los cuales definen la ubicación re¬ 
lativa de los dos ejes en el espacio. 

Para cualesquiera dos ejes en el espacio 3D, existe una medida bien definida de 
distancia entre ellos. Esta distancia se mide a lo largo de una línea que es mutuamente 
perpendicular a ambos ejes. Esta línea mutuamente perpendicular siempre existe; es 
única excepto cuando ambos ejes son paralelos, en cuyo caso hay muchas líneas mutua¬ 
mente perpendiculares de igual longitud. La figura 3.2 muestra el vínculo i — 1 y la lí¬ 
nea mutuamente perpendicular sobre la cual se mide la longitud de vínculo a¡_ v Otra 
manera de visualizar el parámetro del vínculo a ¡ _ ] es imaginar un cilindro en expansión 
cuyo eje es el eje de articulación i — 1; cuando apenas toca el eje de articulación i, el ra¬ 
dio del cilindro es igual a a¡_ v 

El segundo parámetro necesario para definir la ubicación relativa de los dos ejes 
se llama la torsión del vínculo. Si imaginamos un plano cuya normal sea la línea mutua¬ 
mente perpendicular que se acaba de construir, podemos proyectar los ejes i — 1 e i en 
este plano y medir el ángulo entre ellos. Este ángulo se mide desde el eje i — 1 hasta el 
eje i en sentido de la mano derecha, sobre a,_ 1 . 2 Utilizaremos esta definición de la tor¬ 
sión del vínculo i — 1, a ¡ _ y En la figura 3.2, a- : se indica como el ángulo entre el eje 


2 En este caso, a a ¡_j se le asigna la dirección que apunta desde el eje i - 1 hasta el eje i. 
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k- 2 pulg -5 pulg -2 pulg hJ 



FIGURA 3.3: Un vínculo simple que soporta dos ejes angulares. 


¿ — 1 y el eje i (las líneas con tres marcas de referencia son paralelas). En el caso de ejes 
perpendiculares, la torsión se mide en el plano que contiene ambos ejes pero se pierde 
el sentido de a ¡ v En este caso especial tenemos la libertad de asignar el signo de a i X 
arbitrariamente. 

Estos dos parámetros, longitud y torsión, según se definieron anteriormente, 
pueden usarse para definir también la relación entre dos líneas cualesquiera (en este 
caso ejes) en el espacio. 


EJEMPLO 3.1 

La figura 3.3 muestra los dibujos mecánicos de un vínculo de robot. Si este vínculo se 
utiliza en un robot en donde se use el cojinete “A” para la articulación de menor nu¬ 
meración, proporcione la longitud y torsión de este vínculo. Suponga que los hoyos es¬ 
tán centrados en cada cojinete. 

Por inspección, la perpendicular común está justo debajo de la parte media de la 
barra de metal que conecta los cojinetes, por lo que la longitud del vínculo es de 7 pul¬ 
gadas. La vista lateral muestra una proyección de los cojinetes en el plano cuya normal 
es la perpendicular mutua. La torsión del vínculo se mide en el sentido de la mano de¬ 
recha sobre la perpendicular común, desde el eje i — 1 hasta el eje i, por lo que en este 
ejemplo puede verse claramente que es de +45 grados. 


3.3 DESCRIPCIÓN DE LA CONEXIÓN DE VÍNCULOS 

El problema de conectar los vínculos de un robot entre sí también está lleno de pregun¬ 
tas que el ingeniero mecánico debe resolver. Aquí se incluyen la solidez de la articulación, 
su lubricación y el montaje del cojinete y el engranaje. No obstante, para la investigación 
de la cinemática sólo necesitamos preocuparnos por dos cantidades, las cuales especifi¬ 
can completamente la manera en que se conectan los vínculos entre sí. 
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FIGURA 3.4: El desplazamiento del vínculo d y el ángulo de articulación 9 , son dos 
parámetros que pueden usarse para describir la naturaleza de la conexión entre víncu¬ 
los adyacentes. 

Vínculos intermedios en la cadena 

Los vínculos adyacentes tienen un eje de articulación común entre ellos. Uno de los pa¬ 
rámetros de interconexión tiene que ver con la distancia a lo largo de este eje común, 
desde un vínculo hasta el siguiente. Este parámetro se llama desplazamiento del víncu¬ 
lo. El desplazamiento en el eje de articulación i se llama d¡. El segundo parámetro des¬ 
cribe la cantidad de rotación sobre este eje común entre un vínculo y su vínculo 
adyacente. Este parámetro se llama ángulo de articulación, 0¡. 

La figura 3.4 muestra la interconexión del vínculo i—1 y el vínculo i. Recuerde que 
a ¿_| es la perpendicular mutua entre los dos ejes del vínculo i— 1. De igual forma, a¡ es 
la perpendicular mutua definida para el vínculo i. El primer parámetro de intercone¬ 
xión es el desplazamiento del vínculo d p que es la distancia con signo que se mide a lo 
largo del eje de articulación i, desde el punto en el que a ¡1 se interseca con el eje has¬ 
ta el punto en el que a i se interseca con el eje. El desplazamiento d p se indica en la fi¬ 
gura 3.4. El desplazamiento del vínculo d¡ es variable si la articulación i es prismática. 
El segundo parámetro de interconexión es el ángulo que se forma entre una extensión 
de a ¡ _ 1 y a¡, que se mide sobre el eje de la articulación i. Esto se indica en la figura 3.4, 
en donde las líneas con las marcas de referencia dobles son paralelas. A este paráme¬ 
tro se le llama 6 i y es variable para una articulación angular. 

Primer y último vínculos en la cadena 

La longitud de vínculo a¡ y la torsión del vínculo a¡ dependen de los ejes de articulación 
¡e/'+ 1. Por ende, desde a l hasta a n l y desde cq hasta a n _ ¡ se definen según lo que vi¬ 
mos en esta sección. En los extremos de la cadena nuestra convención será asignar ce¬ 
ro a estas cantidades. Esto es, a Q = a n = 0.0 y a 0 = ot n — 0.0. 3 El desplazamiento del 


3 De hecho, a n y oq no necesitan definirse. 
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vínculo d¡ y el ángulo de articulación 9 i están bien definidos para las articulaciones 2 
hasta n — 1, de acuerdo con las convenciones que vimos en esta sección. Si la articula¬ 
ción 1 es angular, la posición cero para 9 1 puede elegirse arbitrariamente; d x — 0.0 será 
nuestra convención. De manera similar, si la articulación 1 es prismática, la posición ce¬ 
ro de d 1 puede elegirse arbitrariamente; 9-¡ = 0 será nuestra convención. Lo mismo se 
aplica exactamente igual a la articulación n. 

Estas convenciones se han seleccionado de manera que, en el caso en que una can¬ 
tidad pudiera asignarse arbitrariamente, se asigna un valor de cero para que los cálculos 
posteriores sean lo más simples que se pueda. 

Parámetros de vínculo 

Cualquier robot puede describirse en forma cinemática proporcionando los valores de 
cuatro cantidades para cada vínculo. Dos describen el vínculo en sí, y los otros dos des¬ 
criben la conexión del vínculo con un vínculo adyacente. En el caso de una articulación 
angular, 6¡ se llama variable de articulación y las otras tres cantidades son parámetros 
de vínculo fijos. Para las articulaciones prismáticas, d¡ es la variable de articulación y las 
otras tres cantidades son parámetros de vínculo fijos. La definición de mecanismos por 
medio de estas cantidades es una convención que generalmente se le conoce como no¬ 
tación Denavit-Hartenberg [l]. 4 Hay otros métodos disponibles para describir meca¬ 
nismos, pero no los presentaremos aquí. 

En este punto podríamos inspeccionar cualquier mecanismo y determinar los pa¬ 
rámetros de Denavit-Hartenberg que lo describen. Para un robot con seis articulacio¬ 
nes se requerirían 18 números para describir completamente la porción fija de su 
cinemática. En el caso de un robot con seis articulaciones, en donde todas son angula¬ 
res, los 18 números se encuentran como seis conjuntos de la forma (a p a¡, ú ). 


EJEMPLO 3.2 

Dos vínculos, según se describe en la figura 3.3, se conectan como los vínculos 1 y 2 de 
un robot. La articulación 2 está compuesta de un cojinete “B” del vínculo 1 y un coji¬ 
nete “A” del vínculo 2, ordenados de manera que las superficies planas de los cojine¬ 
tes “A” y “B” encajen entre sí. ¿Cuánto vale d 2 l 

El desplazamiento de vínculo d 2 es el de la articulación 2, que viene siendo la distan¬ 
cia medida a lo largo del eje de la articulación 2, entre la perpendicular mutua del vínculo 
1 y la del vínculo 2. De los dibujos de la figura 3.3 se puede ver que es de 2.5 pulgadas. 


Antes de introducir más ejemplos, definiremos una convención para adjuntar una 
trama a cada vínculo del manipulador. 

3.4 CONVENCIÓN PARA ASIGNAR TRAMAS A VÍNCULOS 

Para poder describir la ubicación de cada vínculo relativa a sus vínculos adyacentes, de¬ 
finimos una trama unida a cada vínculo. Las tramas de los vínculos se nombran por 
número, de acuerdo al vínculo al cual están unidas. Es decir, la trama {/} se une rígida¬ 
mente al vínculo i. 

4 Tenga en cuenta que muchas convenciones relacionadas tienen el nombre Denavit-Hartenberg, pero 
difieren en algunos detalles. Por ejemplo, la versión utilizada en este libro difiere de otros libros de robó ti¬ 
ca en la manera de numerar tramas. A diferencia de otras convenciones, en este libro la trama {/} está unida 
al vínculo i y tiene su origen en el eje de articulación i. 
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Vínculos intermedios en la cadena 

La convención que utilizaremos para ubicar tramas en los vínculos es la siguiente: El eje 
Z de la trama ¡;¡. llamado Z ¿ , es coincidente con el eje de articulación i. El origen de la 
trama {/} se ubica en donde la perpendicular a¡ se interseca con el eje de articulación i. 
X¡ apunta hacia a ¡ en la dirección de la articulación i hacia la articulación i + 1. 

En el caso de a¡ = 0, X¡ es normal al plano de Z¡ y de Z ¿+1 . Definimos a¡ midién¬ 
dola en sentido de la mano derecha sobre X¡, y así podemos ver que la libertad de ele¬ 
gir el signo de a { en este caso corresponde a dos opciones para la dirección de X¡. Y ¡ se 
forma mediante la regla de la mano derecha para completar la í-ésima trama. La figu¬ 
ra 3.5 muestra la ubicación de las tramas jz-l¡ e {/} para un manipulador general. 

Primero y último vínculos en la cadena 

Adjuntamos una trama a la base del robot, o vínculo 0, a la cual llamaremos trama {0}. 
Esta trama no se mueve; para el problema cinemático del brazo puede considerarse co¬ 
mo la trama de referencia. Podemos describir la posición de todas las demás tramas de 
vínculos en términos de esta trama. 

La trama {0} es arbitraria, por lo que siempre es más simple elegir Z Q sobre el eje 1 
y ubicar la trama {0} de manera que coincida con la trama {1} cuando la variable de ar¬ 
ticulación 1 es cero. Usando esta convención, siempre tendremos que a Q = 0.0, a 0 — 0.0. 
Además, esto asegura que d l = 0.0 si la articulación 1 es angular, o que 6 ] = 0.0 si la 
articulación 1 es prismática. 

Para la articulación n angular, la dirección de X N se selecciona de manera que 
siempre se alinee con Á„ 1 cuando 6 — 0.0, y el origen de la trama {N} se selecciona 
de manera que d n = 0.0. Para la articulación n prismática, la dirección de X N se selec¬ 
ciona de manera que 0 n = 0.0, y el origen de la trama {;V¡ se selecciona en la intersección 
de X N1 y el eje de articulación n cuando d = 0.0. 


Eje i - 1 


Eje i 



Vínculo i 


FIGURA 3.5: Las tramas de los vínculos se unen de manera que la trama {/) se una rígi¬ 
damente al vínculo i. 





Sección 3.4 Convención para asignar tramas a vínculos 69 

Resumen de los parámetros de vínculo en términos de las tramas de los vínculos 

Si las tramas de los vínculos son asignadas de acuerdo con nuestra convención, son vá¬ 
lidas las siguientes definiciones: 

a ¡ = la distancia de Z ( a Z )+| medida sobre X 
cx i = el ángulo de Z. a Z. +| medido sobre 
d = la distancia de X ¿ _ ¡ a X ¡ medida sobre Z ; y 
9 ¡ = el ángulo de Á ;| a X ¡ medido sobre Z ¿ . 

Generalmente elegimos a i > 0 ya que corresponde a una distancia; no obstante a¡, 
d¡ y 9¡ son cantidades con signo. 

Hay que tener en cuenta una observación final sobre la unicidad. La convención 
descrita anteriormente no representa la única manera de asignar tramas a los vínculos. 
Primero que nada, cuando alineamos el eje Z ( con el eje de articulación i hay dos op¬ 
ciones de dirección en las cuales puede apuntar Z ; . Lo que es más, en el caso de ejes 
de articulación que se intersecan (es decir, que a ¡ = 0) hay dos opciones para la direc¬ 
ción de X¡, que corresponden a la opción de signos para la normal en el plano que con¬ 
tenga Z j y Z /+1 . Cuando los ejes i e i + 1 son paralelos, la opción de ubicación del origen 
para {/} es arbitraria (aunque generalmente se selecciona para poder hacer que d¡ sea 
cero). Además, cuando hay articulaciones prismáticas presentes, hay mucha libertad en 
la asignación de tramas. (Vea también el ejemplo 3.5). 

Resumen del procedimiento para asignar tramas a vínculos 

A continuación se presenta un resumen del procedimiento a seguir, cuando nos encon¬ 
tramos con un nuevo mecanismo, para asignar correctamente las tramas de los vínculos: 

1. Identifique los ejes de articulación e imagine (o dibuje) líneas infinitas sobre 
ellos. Para los pasos del 2 al 5, considere dos de estas líneas adyacentes (en los 
ejes i e i + 1). 

2. Identifique la perpendicular común entre ellos, o el punto de intersección. En el 
punto de intersección, o en el punto en el que la perpendicular común se encuen¬ 
tra con el í-ésimo eje, asigne el origen de la trama asociada al vínculo. 

3. Asigne el eje Z ¡ para que apunte sobre el í-ésimo eje de articulación. 

4. Asigne el eje X¡ para que apunte sobre la perpendicular común o, si los ejes se in¬ 
tersecan, asigne X ¡ para que sea normal al plano que contiene los dos ejes. 

5. Asigne el eje Y¡ para completar un sistema de coordenadas de mano derecha. 

6. Asigne {0} para que concuerde con {1} cuando la primera variable de articulación 
sea cero. Para [V¡ seleccione la ubicación del origen y la dirección de X N libre¬ 
mente, pero generalmente de manera que haga que la mayor parte de los pará¬ 
metros de los vínculos sean cero. 


EJEMPLO 3.3 

La figura 3.6(a) muestra un brazo planar de tres vínculos. Como las tres articulaciones 
son angulares, a este manipulador algunas veces se le conoce como mecanismo RRR 
(o 3 R). La figura 3.6(b) es una representación esquemática del mismo manipulador. 
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FIGURA 3.6: Un brazo planar de tres vínculos. A la derecha mostramos el mismo mani¬ 
pulador por medio de una notación esquemática simple. Las marcas de referencia en 
los ejes indican que son mutuamente paralelos. 


Observe las marcas de referencia dobles en cada uno de los tres ejes para indicar que 
son paralelos. Asigne tramas de vínculo a este mecanismo y proporcione los paráme¬ 
tros de Denavit-Hartenberg. 

Empezamos definiendo la trama de referencia, a la que llamaremos trama {0}. Es¬ 
tá fija a la base y se alinea con la trama ¡1} cuando la primera variable de articulación 
(0j) es cero. Por lo tanto, posicionamos la trama {0} como se muestra en la figura 3.7, 
con el eje Z 0 alineado con el eje de la articulación 1. Para este brazo, todos los ejes de 



FIGURA 3.7: Asignaciones de tramas a los vínculos. 
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FIGURA 3.8: Parámetros de vínculo del manipulador planar de tres vínculos. 

articulación están orientados en forma perpendicular al plano del brazo. Como el bra¬ 
zo se encuentra en un plano con todos los ejes Z paralelos, no hay desplazamientos de 
vínculo; todas las d ¡ son cero. Todas las articulaciones son giratorias, por lo que cuan¬ 
do están a cero grados todos los ejes X deben alinearse. 

Teniendo en cuenta estos comentarios, es fácil encontrar las asignaciones de tra¬ 
mas que se muestran en la figura 3.7. Los parámetros de vínculo correspondientes se 
muestran en la figura 3.8. 

Observe que, como los ejes de articulación son todos paralelos y todos los ejes Z 
se consideran como apuntando hacia fuera del papel, todas las a ¡ son cero. Éste es ob¬ 
viamente un mecanismo muy simple. Observe también que nuestro análisis cinemático 
siempre termina en una trama cuyo origen se encuentra en el último eje de articulación; 
por lo tanto, / 3 no aparece en los parámetros de vínculo. Dichos desplazamientos fina¬ 
les hacia el efector final se tratarán por separado más adelante. 


EJEMPLO 3.4 

La figura 3.9(a) muestra un robot que tiene tres grados de libertad y una articulación 
prismática. A este manipulador se le puede llamar “mecanismo RPR ”, en una notación 
que especifique el tipo y orden de las articulaciones. Es un robot “cilindrico” cuyas pri¬ 
meras dos articulaciones son análogas a las coordenadas polares cuando se les ve desde 
arriba. La última articulación (3) proporciona el “giro” para la mano. La figura 3.9(b) 
muestra el mismo manipulador en forma esquemática. Observe el símbolo utilizado 


Articulación 2 Articulación 3 



(a) (b) 


FIGURA 3.9: Un manipulador con tres grados de libertad y una articulación prismática. 
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FIGURA 3.10: Asignaciones tramas a los vínculos. 


para representar articulaciones prismáticas y también que se utiliza un “punto” para 
indicar el lugar en el que se intersecan dos ejes adyacentes. Además, se ha indicado el 
hecho de que los ejes 1 y 2 son ortogonales. 

La figura 3.10(a) muestra al manipulador con la articulación prismática en su mí¬ 
nima extensión; la asignación de tramas a los vínculos se muestra en la figura 3.10(b). 

Observe que las tramas {0} y {1} se muestran como exactamente coincidentes en 
esta figura, ya que el robot se dibuja para la posición G l = 0. Observe que la trama |0¡, 
aunque no se encuentra en la parte inferior de la base bridada del robot, está unida rí¬ 
gidamente al vínculo 0, la parte inmóvil del robot. Así como nuestras tramas de víncu¬ 
los no se utilizan para describir el desplazamiento hasta llegar a la mano, no necesitan 
unirse completamente hasta la parte más baja de la base del robot. Es suficiente que se 
una la trama {0} en cualquier parte al vínculo fijo 0, y que la trama {/Y¡ (la trama final) 
se una en cualquier parte al último vínculo del manipulador. Otros desplazamientos po¬ 
drán manejarse posteriormente de una manera general. 

Note que las articulaciones giran sobre el eje Z de la trama asociada, pero las ar¬ 
ticulaciones prismáticas se deslizan a lo largo de Z. En el caso en que la articulación i 
sea prismática, 6 ¡ es una constante fija y d ¡ es la variable. Si d j es cero en la mínima ex¬ 
tensión del vínculo, entonces la trama {2} deberá unirse en donde se muestra, para que 
d 2 proporcione el verdadero desplazamiento. Los parámetros de vínculo se muestran 
en la figura 3.11. 

Observe que 6 2 es cero para este robot y que d 7 es una variable. Los ejes 1 y 2 se 
intersecan, por lo que a í es cero. El ángulo oq debe ser de 90 grados para poder girar 
Z l de manera que se alinee con Z 7 (sobre Aj). 


EJEMPLO 3.5 

La figura 3.12(a) muestra un manipulador 3 R de tres vínculos, en el que los ejes de 
articulación 1 y 2 se intersecan y los ejes 2 y 3 son paralelos. La figura 3.12(b) muestra 
el esquema cinemático del manipulador. Observe que el esquema incluye anotacio¬ 
nes que indican que los primeros dos ejes son ortogonales y que los últimos dos son 
paralelos. 

Demuestre la no unicidad de las asignaciones de tramas y de los parámetros de 
Denavit-Hartenberg, mostrando varias posibles asignaciones correctas de las tramas 

{i} y {2}. 
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FIGURA 3.11: Parámetros de vínculo para el manipulador RPR del ejemplo 3.4. 



(a) (b) 


FIGURA 3.12: Manipulador no planar de tres vínculos. 


La figura 3.13 muestra dos posibles asignaciones de tramas y los parámetros co¬ 
rrespondientes para las dos posibles opciones de dirección de Z 7 . 

En general, cuando Z ( y Z +1 se intersecan hay dos opciones para X. En este 
ejemplo, los ejes de articulación 1 y 2 se intersecan, por lo que hay dos opciones para 
la dirección de X y La figura 3.14 muestra otras dos posibles asignaciones de tramas que 
corresponden a la segunda opción de X y 

De hecho hay cuatro posibilidades más que corresponden a las cuatro opciones 
anteriores, pero con Z, apuntando hacia abajo. 


3.5 CINEMÁTICA DE MANIPULADORES 

En esta sección derivaremos la forma general de la transformación que relaciona las 
tramas unidas a vínculos adyacentes. Luego concatenaremos estas transformaciones in¬ 
dividuales para despejar la posición y orientación del vínculo n relativo al vínculo 0. 
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di — 0 d 2 — L\ di — 0 d 2 - L 2 

FIGURA 3.13: Dos posibles asignaciones de tramas. 



Cll — 0 (X 2 — í-‘2 

ai = 90° a 2 — 0 

d\ = 0 d2 — Li 


d 2 = 90° 

FIGURA 3.14: Otras dos posibles asignaciones de tramas. 


ai = o 
ai = —90° 
di = 0 


a 2 ~ ^2 

a 2 — 0 0 2 = —90° 

d 2 = ~ Li 


Derivación de transformaciones de vínculos 

Deseamos construir la transformada que define la trama {/} relativa a la trama {/ — lj. 
En general, esta transformación será una función de los cuatro parámetros de vínculo. 
Para cualquier robot dado, esta transformación será una función de una variable sola¬ 
mente, y los otros tres parámetros serán fijos por diseño mecánico. Al definir una 
trama para cada vínculo hemos descompuesto el problema de cinemática en n subpro¬ 
blemas. Para poder resolver cada uno de estos subproblemas, específicamente l ~\ T , los 
desglosaremos aún más en cuatro “subsubproblemas”. Cada una de estas transforma¬ 
ciones será una función de un parámetro de vínculo solamente, y será lo suficientemente 
simple corno para que podamos anotar su forma por inspección. Empezaremos defi¬ 
niendo tres tramas intermedias para cada vínculo: ¡Pj, { Q j y {R}. 

La figura 3.15 muestra el mismo par de articulaciones de antes, con las tramas (Pj, 
{Q} y (Pj definidas. Observe que sólo se muestran los ejes JyZde cada trama, para 
que el dibujo sea más claro. La trama (Pj difiere de la trama {/ — lj sólo por una rota¬ 
ción de a¡_ v 
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Eje i - 1 Eje i 



FIGURA 3.15: Ubicación de tramas intermedias {P}, { Q ¡ y ¡i?¡. 


La trama {Q} difiere de ¡Rj por una traslación a- v La trama ¡Pj difiere de ¡Qj por una 
rotación 0 ¡ , y la trama {/} difiere de \P\ por una traslación d¡. Si deseamos escribir la 
transformación que modifica los vectores definidos en {i} a su descripción en {/— 1), po¬ 
demos hacerlo de la siguiente forma 

i —1 p i —1 r j~' R t Q r r P r r i p 

R Q P i 

O 

/—I p __ i —1 p i p 

i ’ 

en donde 

i — 1 t i — 1 nr R t Q r r P r r 

i R Q P i 

Considerando cada una de estas transformaciones, podemos ver que la ecuación (3.3) 
puede escribirse así: 


(3.1) 

(3.2) 

(3.3) 


‘-)T = R x (a l _ ] )D x (a l _ ] )R z (e i )D z (d l ), 


(3.4) 


O 

' j T = Tornillo x (a¿_ ,, a¡_ { ) Tornillo z (d / , 9¡), (3.5) 

en donde la notación Tornillo^//; 0) representa la combinación de una traslación sobre 
un eje Q por una distancia r y una rotación sobre el mismo eje por un ángulo 0. Reali¬ 
zando la multiplicación en la ecuación (3.4) obtenemos la forma general de Í_1 ¿ T: 



c6¡ —0 a { _Y 

sOjCcij-i cO^oij-i —sa¡_i —sa^^dj 
sQjSoti-i cO¡sa | _ 1 ca ¡_ 1 ca^^dj 

0 0 0 1 


(3.6) 
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EJEMPLO 3.6 

Utilizando los parámetros de vínculo mostrados en la figura 3.11 para el robot de la fi¬ 
gura 3.9, calcule las transformaciones individuales para cada vínculo. 

Sustituyendo los parámetros en la ecuación (3.6), obtenemos 


o 

i 


T = 


1 

2 


T 


2 

3 


T 


c0 1 -s0 l 0 0 
s6 1 c6 l 0 0 
0 0 10’ 
0 0 0 1 

'10 0 o" 

0 0-1 -d 2 
0 10 0 ’ 

0 0 0 1 

c0 3 -se 3 o o" 
s0 3 cd 3 0 0 
0 0 1 í 2 ' 

0 0 0 1 


(3.7) 


Una vez que hayamos derivado estas transformaciones de vínculos, será conveniente 
comprobarlos con sentido común. Por ejemplo, los elementos de la cuarta columna de 
cada transformación deben dar las coordenadas del origen de la siguiente trama de ma¬ 
yor orden. 


Concatenación de las transformaciones de vínculos 


Una vez que se han definido las tramas de vínculo y se han encontrado los correspon¬ 
dientes parámetros de vínculo, es muy simple desarrollar las ecuaciones cinemáticas. 
Las matrices de transformación de vínculos individuales pueden calcularse a partir de 
los valores de los parámetros de vínculo. Después pueden multiplicarse las transforma¬ 
ciones de vínculo entre sí para encontrar la transformación que relaciona la trama {/Y¡ 
con la trama ¡0¡: 


0 r J~ 1 _ 0’T’ 1 r T' 2,'T’ N — 1 m 

N 1 2 3 N 


(3.8) 


Esta transformación ^ T será una función de todas las n variables de articulación. Si se 
consultan los sensores de posición de articulación del robot, puede calcularse la posi¬ 
ción y orientación cartesiana del último vínculo mediante ^ T. 


3.6 ESPACIO DE ACTUADOR, ESPACIO DE ARTICULACIÓN Y ESPACIO CARTESIANO 

La posición de todos los vínculos de un manipulador con n grados de libertad puede es¬ 
pecificarse con un conjunto de n variables de articulación. Este conjunto de variables a 
menudo se conoce como el vector de articulación de n x 1. El espacio de dichos vectores 
de articulación se conoce como espacio de articulación. Hasta ahora nos hemos preocu¬ 
pado por calcular la descripción de espacio cartesiano a partir de la descripción del espa¬ 
cio de articulación. Utilizamos el término espacio cartesiano cuando la posición se mide 
a lo largo de ejes ortogonales y la orientación se mide de acuerdo con cualquiera de las 
convenciones descritas en el capítulo 2. Algunas veces se utilizan los términos espacio 
orientado a tarea y espacio operacional para lo que llamaremos espacio cartesiano. 










Sección 3.7 Ejemplos: cinemática de dos robots industriales 77 



FIGURA 3.16: Asignaciones entre descripciones cinemáticas. 


Hasta ahora hemos asumido implícitamente que cada articulación cinemática es ac¬ 
cionada directamente por algún tipo de actuador. No obstante, en el caso de muchos ro¬ 
bots industriales, esto no es así. Por ejemplo, algunas veces dos actuadores trabajan juntos 
en un par diferencial para mover una sola articulación; otras veces se utiliza un actuador 
lineal para girar una articulación angular mediante el uso de una vinculación de cuatro ba¬ 
rras. En estos casos es útil considerar la noción de posiciones de actuador. Los sensores que 
miden la posición del manipulador a menudo se encuentran ubicados en los actuadores, 
por lo que deben realizarse ciertos cálculos para determinar el vector de articulación co¬ 
mo una función del conjunto de valores de un actuador, o vector de actuador. 

Como se indica en la figura 3.16, hay tres representaciones de la posición y la 
orientación de un manipulador: descripciones en espacio de actuador, en espacio de ar¬ 
ticulación y en espacio cartesiano. En este capítulo nos interesan las asignaciones entre 
representaciones, según lo indican las flechas sólidas en la figura 3.16. En el capítulo 4 
consideraremos las asignaciones inversas, indicadas por las flechas punteadas. 

Hay muchas formas en que los actuadores se pueden conectar para mover una ar¬ 
ticulación; podrían catalogarse, pero no haremos eso aquí. Para cada robot que diseñe¬ 
mos o busquemos analizar, debemos averiguar la correspondencia entre las posiciones 
de los actuadores y las posiciones de las articulaciones. En la siguiente sección resolve¬ 
remos un problema de ejemplo para un robot industrial. 

3.7 EJEMPLOS: CINEMÁTICA DE DOS ROBOTS INDUSTRIALES 

Los robots industriales actuales están disponibles en muchas configuraciones cinemáti¬ 
cas [2], [3]. En esta sección trabajaremos con el comportamiento cinemático de dos ro¬ 
bots industriales típicos. Primero consideraremos el Unimation PUMA 560, un 
manipulador de articulación giratoria con seis grados de libertad. Resolveremos las 
ecuaciones cinemáticas como funciones de los ángulos de articulación. Para este ejem¬ 
plo omitiremos el problema adicional de la relación entre el espacio de actuador y el 
espacio de articulación. En segundo lugar consideraremos el Yasukawa Motoman L-3, 
un robot con cinco grados de libertad y articulaciones giratorias. Realizaremos este 
ejemplo con todo detalle, incluyendo las transformaciones de actuador a articulación. 
Si es la primera vez que lee este libro, puede omitir este ejemplo. 

El PUMA 560 

El Unimation PUMA 560 (figura 3.17) es un robot con seis grados de libertad y todas 
las articulaciones giratorias (es decir, es un mecanismo 6 R). En la figura 3.18 se muestra 
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FIGURA 3.17: El Unimation PUMA 560. Cortesía de Unimation Incorporated, Shelter 
Rock Lañe, Danbury, Conn. 


con asignaciones de tramas en la posición para la que todos los ángulos de articulación 
son iguales a cero. 5 La figura 3.19 muestra los detalles del antebrazo del robot. 

Observe que la trama {0} (que no se muestra) es coincidente con la trama {1} 
cuando 9 1 es cero. Observe también que, para este robot, al igual que para muchos ro¬ 
bots industriales, los ejes de las articulaciones 4, 5 y 6 se intersecan todos en un punto 
común, y este punto de intersección coincide con el origen de las tramas ¡4¡, {5} y ¡6¡. 
Lo que es más, los ejes de articulación 4, 5 y 6 son mutuamente ortogonales. Este me¬ 
canismo de muñeca se muestra esquemáticamente en la figura 3.20. 

Los parámetros de vínculo que corresponden a esta disposición de tramas de víncu¬ 
los se muestran en la figura 3.21. En el caso del PUMA 560, una combinación de engra¬ 
najes en la muñeca del manipulador acopla los movimientos de las articulaciones 4, 5 y 
6. Esto significa que para estas tres articulaciones debemos hacer una distinción entre 
espacio de articulación y espacio de actuador, y resolver la cinemática completa en dos 
pasos. No obstante, en este ejemplo consideraremos solamente la cinemática del espa¬ 
cio de articulación al espacio cartesiano. 


5 Unimation ha utilizado una asignación ligeramente distinta de la ubicación cero de las articulaciones, 
de tal forma que 8^ = 0 3 — 180°, en donde 8Í es la posición de la articulación 3 en la convención de 
Unimation. 
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FIGURA 3.18: Algunos parámetros de cinemática y asignaciones de tramas para el ma¬ 
nipulador PUMA 560. 



FIGURA 3.19: Parámetros cinemáticos y asignaciones de tramas para el antebrazo del 
manipulador PUMA 560. 
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FIGURA 3.20: Diagrama esquemático de una muñeca 3R en la que los tres ejes se inter¬ 
secan en un punto y son mutuamente ortogonales. Este diseño se utiliza en el manipu¬ 
lador PUMA 560 y en muchos otros robots industriales. 
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FIGURA 3.21: Parámetros de vínculo del PUMA 560. 
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Utilizando la ecuación (3.6) calculamos cada una de las transformaciones de 
vínculo: 


o 

i 


T = 


1 

2 


T = 


c9i 

1 
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0 


s9i 

c9 

0 
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0 

0 

1 
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0 
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c9 2 


s9 2 
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c9 2 
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«3 
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0 
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—sB 4 
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0 

0 

0 

0 

1 
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0 

0 
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0 

s9 5 

c9 5 

0 

0 

o ( 

0 

0 

1 

c9 6 

-s9 6 

0 

0 

0 

0 

1 

0 

-s9 6 

-c9 6 

0 

0 

0 

0 

0 

1 


(3.9) 


Ahora formamos 6 T mediante la multiplicación matricial de las matrices de víncu¬ 
lo individuales. Mientras formamos este producto, derivaremos algunos subresultados 
que serán útiles para resolver el problema de cinemática inversa que se presenta en el 
capítulo 4. Empezaremos multiplicando 1 T y 5 6 T ; esto es: 


4 nr _ 4 r j 1 5 r T' 

6 - 5 6 


C 5 C 6 ~ C 5 S 6 ~ s 5 0 
S 6 C 6 0 0 

S 5 C 6 ~ S 5 S 6 c 5 0 

0 0 0 1 


(3.10) 


en donde c 5 es abreviación de eos & 5 , $ 5 de sen 9 5 y así sucesivamente. 6 Así, tenemos que 

C4C5C6 ^4^6 ^4^5^6 ^4^6 ^4^5 ^3 


l T = ]t 4 J = 
6 4 6 


* 5^6 

-Í 4 c 5 c 6 - c 4 s 6 
0 


~ S 5 S 6 

S 4 C 5 S 6 ~ C 4 C 6 
0 


c 5 

s 4 s 5 

0 


d 4 

0 

1 


(3.11) 


6 Dependiendo de la cantidad de espacio disponible para mostrar las expresiones, utilizaremos cualquie¬ 
ra de las siguientes tres formas: eos & s , cd 5 o c 5 . 
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Como las articulaciones 2 y 3 son siempre paralelas, si multiplicamos primero \T y\T 
y luego aplicamos fórmulas para sumar ángulos, obtendremos una expresión final más 
simple. Esto puede hacerse siempre que dos articulaciones giratorias tengan ejes para¬ 
lelos; así, tenemos que 


1 y _ ly 2y _ 

3 “23 


c 23 —í 23 0 a 2 c 2 

0 0 1 ¿i, 

_í 23 ~ c 23 0 — «2 í 2 

0 0 0 1 


(3.12) 


en donde hemos usado las fórmulas de suma de ángulos (del apéndice A): 


c 23 — C 2 C 3 ~ S 2 S 3' 


s 23 ~ C 7 S 3 + S 7 C 3- 


L 2 J 3 


2 L 3‘ 


Después tenemos que 


ri 


1 _ \j?>j 


Di 

r 21 


'31 


r 12 lr 13 
r 22 lr 23 

r 32 lr 33 

0 0 


l p ^ 

V 

V- 

1 


en donde 


lr ll = C 23[ C 4 C 5 C 6 ~ — S 23 S 5 S 6< 

lr 21 = _Í 4 C 5 C 6 _ C 4 S 6> 
lr 31 = _Í 23[ C 4 C 5 C 6 _ s 4 s ó] ~ C 23 S 5 C 6’ 
1, "l2 = -C 2 3[C 4 C 5 Í 6 + í 4 C 6 ] + S 2 jS¡S 6 , 

lr 22 = S 4 C 5 S 6 ~ C 4 C 6’ 

1,- 32 = s 73\- c 4 c 5 s 6 + S 4 C & + C 23 S 5 S 6’ 
lr 13 = _C 23 C 4 S 5 ~ s 23 c 5’ 

1 r 23 = s 4 s 5 , 

lr 33 = S 23 C 4 S 5 _ c 23 c 5’ 

1 Px = a 2 c 2 + a 3 c 23~ d 4 s 23’ 

1 P y = d 3’ 

l Px = -a 3 í 2 3 - «2^2-^23- 


(3.13) 


Finalmente obtenemos el producto de las seis transformadas de vínculos: 


0 t _ 0 y 1 t _ 

6 “16 


Di r 12 r 13 Px 
r 2l r 22 r 23 Py 

r 31 r 32 r 33 Pz 

0 0 0 1 
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Aquí, 


r 1 ¡ = c l[ c 23( c 4 c 5 c 6 _ * 4 * 5 ) ~ S 23 S 5 C 5^ + *1 (*4 C 5 C 6 + c 4 * 6 )> 
r 21 = *1 t c 23( C 4 C 5 C 6 ~ *4*6) ~ *23*5 C 6 ~ c l(*4 c 5 c 6 + c 4*6)> 
r 31 = — *23( C 4 C 5 C 6 — *4*ó) — C 23*5 C 6’ 

r 12 = C 1 t c 23 ( C '4 C 5*6 - *4 c ó) + *23*5*ó) + *l( c 4 c 6 ~ *4 c 5*ó)’ 
r 22 = *1 t c 23( C 4 C 5*6 — *4 c ó) + *23*5*ó] _ c l( c 4 c 6 _ *4 C 5*6)> 
r 32 = *23 ( C 4 C 5*6 _ *4 c ó) + c 23*5*6> 

r 13 ~ ~ c l( c 23 c 4*5 + *23 c 5) _ *1*4*5’ 
r 23 ~ _ *l( c 23 c 4*5 + *23 c 5) + c l*4*5’ 
r 33 ~ *23 c 4*5 ~ c 23 c 5’ 

Px = c lt fl 2 c 2 + a 3 c 23 ~ ^4*23] - ¿3*1- 
Py = *l[«2 c 2 + a 3 c 23 ~ ¿4*23] + ¿3 C 1> 

Pz~~ a 3*23 — fl 2*2 “ ¿4 C 23- (3-14) 

Las ecuaciones (3.14) constituyen la cinemática del PUMA 560. Especifican cómo calcu¬ 
lar la posición y la orientación de la trama {6} relativa a la trama {0} del robot. Éstas 
son las ecuaciones básicas para todos los análisis cinemáticos de este manipulador. 

El Yasukawa Motoman L-3 

Este robot es un manipulador industrial popular con cinco grados de libertad (figura 
3.22). A diferencia de los ejemplos que hemos visto hasta ahora, el Motoman no es 
una simple cadena cinemática abierta sino que utiliza dos actuadores lineales acopla¬ 
dos a los vínculos 2 y 3, con articulaciones de 4 barras. Además, las articulaciones 4 y 
5 se operan a través de una transmisión de cadena por dos actuadores, en un arreglo 
diferencial. 

En este ejemplo resolveremos su comportamiento cinemático en dos etapas. Pri¬ 
mero despejaremos los ángulos de articulación en términos de las posiciones de los ac¬ 
tuadores; después despejaremos la posición y orientación cartesiana del último vínculo 
en términos de los ángulos de articulación. En esta segunda etapa podemos tratar el sis¬ 
tema como si fuera un dispositivo 5 R de cadena cinemática abierta simple. 

La figura 3.23 muestra el mecanismo articulado que conecta el actuador número 
2 con los vínculos 2 y 3 del robot. El actuador es lineal y controla directamente la lon¬ 
gitud del segmento etiquetado como DC. El triángulo ABC es fijo, al igual que la longitud 
BD. La articulación 2 pivotea sobre el punto B y el actuador pivotea ligeramente sobre 
el punto C al moverse la articulación. Daremos los siguientes nombres a las constantes 
(longitudes y ángulos) asociadas con el actuador 2: 

y 2 = AB, (f>2 = AC, &2 — BC, 


p 2 = BD , Q 2 = LJBD, l 2 = BJ, 
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FIGURA 3.22: El Yasukawa Motoman L-3. Cortesía de Yasukawa. 


daremos los siguientes nombres a las variables: 

0 2 = - LJBQ , yr 2 = LCBD , g 2 = DC. 

La figura 3.24 muestra el mecanismo de unión que conecta al actuador número 3 
con los vínculos 2 y 3 del robot. El actuador es lineal y controla directamente la longi¬ 
tud del segmento etiquetado como HG. El triángulo EFG es fijo, al igual que la longi¬ 
tud FH. La articulación 3 pivotea sobre el punto / y el actuador pivotea ligeramente 
sobre el punto G, a medida que se mueve la articulación. Daremos los siguientes nom¬ 
bres a las constantes (longitudes y ángulos) asociadas con el actuador 3: 

y 3 = EF, </>3 = EG, «3 = GF, 

P 3 = HF , l 3 = JK. 


Daremos los siguientes nombres a las variables: 


0 3 = LPJK, Vr 3 = LGFH , g 3 = GH. 


Este arreglo de actuadores y articulaciones tiene el siguiente efecto funcional. El 
actuador 2 se utiliza para posicionar la articulación 2; mientras hace esto, el vínculo 3 
permanece en la misma orientación relativa a la base del robot. El actuador 3 se utiliza 
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FIGURA 3.23: Detalles cinemáticos de la articulación del actuador 2 de Yasukawa. 

para ajustar la orientación del vínculo 3 respecto a la base del robot (en vez de ser res¬ 
pecto al vínculo anterior, como en un robot de cadena cinemática serial). Un propósito 
de dicho arreglo de articulaciones es incrementar la rigidez estructural de las articulacio¬ 
nes principales del robot. Esto a menudo recompensa en términos de una mayor habi¬ 
lidad para posicionar el robot con precisión. 

Los actuadotes para las articulaciones 4 y 5 se unen al vínculo 1 del robot con sus 
ejes alineados con los de la articulación 2 (puntos B y Fen las figuras 3.23 y 3.24). Ope¬ 
ran las articulaciones de la muñeca mediante dos conjuntos de cadenas: uno localizado 
de manera interior al vínculo 2, el segundo localizado de manera interior al vínculo 3. 
El efecto de este sistema de transmisión, junto con su interacción con el accionamien¬ 
to de los vínculos 2 y 3, se describe funcionalmente de la siguiente manera: el actuador 
4 se utiliza para posicionar la articulación 4 relativa a la base del robot, en vez de ser 
relativa al vínculo 3 anterior. Esto significa que si el actuador 4 se mantiene constante, 
el vínculo 4 se mantendrá a una orientación constante con respecto a la base del robot, 
sin importar las posiciones de las articulaciones 2 y 3. Finalmente, el actuador 5 se com¬ 
porta como si estuviera directamente conectado a la articulación 5. 

Ahora definiremos las ecuaciones que asignan un conjunto de valores de actuador 
(A.) al conjunto equivalente de valores de articulación (0 ¿ ). En este caso, estas ecuacio¬ 
nes se derivaron mediante geometría plana elemental; la mayoría con la sola aplicación 
de la “ley de los cosenos.” 7 

7 Si los ángulos de un triángulo son a, b y c, en donde el ángulo 9 se encuentra opuesto al lado A, y así 
sucesivamente, entonces A 2 = B 2 + C 2 — 2 BC eos a. 
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FIGURA 3.24: Detalles cinemáticos de la articulación del actuador 3 de Yasukawa. 


En estas ecuaciones aparecen las constantes de escala (k¡) y desplazamiento (X¡) para 
cada actuador. Por ejemplo, el actuador 1 está conectado directamente al eje de articu¬ 
lación 1, por lo que la conversión es simple; se trata únicamente de un factor de escala 
más un desplazamiento. Por lo tanto, 


a -1 (^j + Í2 2 — 270°, 

+ tan -1 -90°, 

(3.15) 


La figura 3.25 muestra la asignación de tramas a los vínculos. En esta figura el ma¬ 
nipulador se muestra en una posición correspondiente al vector de articulación 0 = (0, 
—90°, 90°, 90°, 0). La figura 3.26 muestra los parámetros de vínculo para este manipu¬ 
lador. Las matrices de transformación de vínculos que se obtienen son 


% — "b L|, 


= eos 


= eos 


_1 / (M2 + X 2) 2 - “2 “ ¿2 



ta 


-2ci 3 p 3 

% = -k 4 A 4 -0 2 -e 3 + X 4 + 180°, 
^5 = + X 3 . 
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2 
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0 

0 


0 1 

c(9 3 

-s9 3 

0 

h 

s6 3 

c9 3 

0 

0 

0 

0 

1 

0 

0 

0 

0 

1 

cd 4 

-s9 4 

0 

h 

s9 4 

c9 4 

0 

0 

0 

0 

1 

0 

0 

0 

0 

1 

c9 5 

-s9 5 
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0 
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1 0 

s9 5 

c9 5 
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0 
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0 1 


(3.16) 



FIGURA 3.25: Asignación de las tramas de vínculo para el Yasukawa L-3. 
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“i ~ 1 

a i - 1 

d¡ 

e, 

1 

0 

0 

0 

0i 
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0 
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90 ° 

0 

0 

05 


FIGURA 3.26: Parámetros de vínculo del manipulador Yasukawa L-3. 


Formando el producto para obtener 2 T, obtenemos 


o 

5 


T = 


r U r 12 r 13 Px 
r 21 r 22 r 23 Py 

r 31 r 32 r 33 Pz 

0 0 0 1 


en donde 


r í\ ~ c l c 234 c 5 _ s l s 5> 
r 21 = í l c 234 c 5 + c l s 5’ 
r 31 = ‘ s 234 c 5’ 

r 12 ~ ~ c l c 234‘ s 5 _ s l c 5’ 
r 22 = _ ' s l c 234 s 5 + c l c 5’ 


r 32 ~ í 234 í 5 > 

r 13 = c l s 234’ 
r 23 = í l í 234> 


r 33 — c 234’ 
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Px — c l( l 2 c 2 + ^3 C 23)’ 

Py ~ s l(h c 2 + ; 3 C 23)’ 

Pz = ~h s 2 ~ h s 23- (3-17) 

Desarrollamos las ecuaciones cinemáticas para el Yasukawa Motoman en dos 
pasos: en el primero calculamos un vector de articulación a partir de un vector de ac- 
tuador; en el segundo calculamos una posición y orientación de la trama de la muñeca 
a partir del vector de articulación. Si deseamos calcular sólo la posición cartesiana y no 
los ángulos de articulación es posible derivar ecuaciones que correlacionen directamen¬ 
te al espacio de actuador con el espacio cartesiano. Estas ecuaciones son un poco más 
simples en cuanto al aspecto computacional que el método de dos pasos. (Vea el ejer¬ 
cicio 3.10). 

3.8 TRAMAS CON NOMBRES ESTÁNDAR 

Por cuestión de convención será útil si asignamos nombres y ubicaciones específicas a 
ciertas tramas “estándar” asociadas con un robot y su espacio de trabajo. La figura 
3.27 muestra una situación común en la que un robot ha sujetado algún tipo de herra¬ 
mienta y está por colocar la punta de la herramienta en una ubicación definida por el 
usuario. Se hace referencia a las cinco tramas indicadas en la figura 3.27 con tanta fre¬ 
cuencia que definiremos nombres para ellas. El nombramiento y uso subsecuente de 
estas cinco tramas en un sistema de programación y control de robots facilita crear ha¬ 
bilidades generales en una manera fácilmente comprensible. Todos los movimientos 
del robot se describirán en términos de estas tramas. 

A continuación veremos unas breves definiciones de las tramas que se muestran 
en la figura 3.27. 

Trama base, {B} 

¡5¡ está ubicada en la base del manipulador. Es simplemente otro nombre para la tra¬ 
ma ¡0¡. Está sujeta a una parte inmóvil del robot, algunas veces llamada vínculo 0. 



FIGURA 3.27: Tramas estándar. 
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Trama estación, {S} 

¡Sj está ubicada en una posición relacionada con la tarea en cuestión. En la figura 3.28 
se encuentra en la esquina de una mesa sobre la cual va a trabajar el robot. En lo que 
respecta al usuario de este sistema de robot, ¡Sj es la trama universal y todas las accio¬ 
nes del robot se realizan en forma relativa a la misma. Algunas veces se le llama trama 
de tarea, trama mundial o trama universal. La trama estación siempre se especifica con 
respecto a la trama base, que viene siendo %T. 

Trama muñeca, {W} 

¡W¡ está sujeta al último vínculo del manipulador. Es otro nombre para la trama {N}, 
la trama de vínculo unida al último vínculo del robot. Es muy común que ¡W¡ tenga su 
origen fijo en un punto llamado la muñeca del manipulador, y |W¡ se mueve con el úl¬ 
timo vínculo del manipulador. Se define de manera relativa a la trama base, es decir, 



Trama herramienta, {T} 

¡rj está sujeta al extremo de cualquier herramienta que el robot esté sujetando. Cuan¬ 
do la mano está vacía, { T] generalmente se ubica con su origen entre las puntas de los 
dedos del robot. La trama herramienta siempre se especifica con respecto a la trama 
muñeca. En la figura 3.28 la trama herramienta se define con su origen en la punta de 
un perno que el robot está sujetando. 



FIGURA 3.28: Ejemplo de la asignación de tramas estándar. 
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Trama objetivo, {G} 

¡G) es una descripción de la ubicación a la cual el robot va a mover la herramienta. Es¬ 
pecíficamente esto significa que al final del movimiento la trama herramienta debe mo¬ 
verse para que coincida con la trama objetivo. ¡Gj siempre se especifica en relación con 
la trama estación. En la figura 3.28 el objetivo se encuentra en un hoyo en el que de¬ 
seamos insertar un perno. 

Todos los movimientos de los robots pueden describirse en términos de estas tra¬ 
mas sin perder generalidad. Su uso nos proporciona un lenguaje estándar para hablar 
sobre las tareas de los robots. 


3.9 ¿EN DÓNDE ESTÁ LA HERRAMIENTA? 

Una de las primeras habilidades que debe tener un robot es poder calcular la posición 
y orientación de la herramienta que está sujetando (o de su mano vacía) con respecto 
a un sistema de coordenadas conveniente. Esto es, deseamos calcular el valor de la tra¬ 
ma herramienta ¡7] relativa a la trama estación ¡Sj. Una vez que se haya calculado 
mediante las ecuaciones cinemáticas podemos usar transformadas cartesianas, como se 
estudió en el capítulo 2, para calcular ¡7j con respecto a ¡5). Al resolver una simple 
ecuación de transformadas obtenemos 


s r T = B s T~ l b w T ™T. (3.18) 

La ecuación (3.18) implementa lo que se conoce como la función DONDE en algunos 
sistemas de robots. Calcula en “dónde” se encuentra el brazo. Para la situación en la fi¬ 
gura 3.28, la salida de DONDE sería la posición y orientación del perno, en relación a 
la cubierta de la mesa. 

Se puede considerar que la ecuación (3.18) generaliza la cinemática. jT calcula la 
cinemática debida a la geometría de las articulaciones, junto con una transformada ge¬ 
neral (que podría considerarse como un vínculo fijo) en el extremo de la base (?T) y 
otra en el efector final C^T). Estas transformadas adicionales nos permiten incluir he¬ 
rramientas con desplazamientos y torceduras, además de operar con respecto a una tra¬ 
ma estación arbitraria. 


3.10 CONSIDERACIONES COMPUTACIONALES 

En muchos sistemas manipuladores prácticos hay que tener en cuenta el tiempo reque¬ 
rido para realizar cálculos cinemáticos. En esta sección hablaremos brevemente sobre 
varias cuestiones relacionadas con el cálculo de la cinemática de los manipuladores, co¬ 
mo se ejemplifica mediante la ecuación (3.14) para el caso del PUMA 560. 

Una opción a elegir es el uso de la representación fija o de punto flotante para las 
cantidades involucradas. Muchas implementaciones usan punto flotante para facilitar 
el desarrollo del software, ya que el programador no tiene que preocuparse por las ope¬ 
raciones de escala que capturan las magnitudes relativas de las variables. No obstante, 
cuando la velocidad es crucial es muy factible usar la representación de punto fijo, ya 
que las variables no tienen un rango dinámico extenso, y estos rangos son bastante co¬ 
nocidos. Una estimación aproximada del número de bits necesarios en la representa¬ 
ción de punto fijo parece indicar que 24 son suficientes [4], 

Al factorizar ecuaciones tales como la (3.14) es posible reducir el número de mul¬ 
tiplicaciones y sumas, con la desventaja de crear variables locales (lo que generalmen¬ 
te es aceptable). La idea es evitar términos comunes de cómputo una y otra vez a lo 
largo del cálculo. Se ha hecho cierta aplicación de factorización automática asistida por 
computadora para dichas ecuaciones [5]. 
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El mayor problema de los cálculos cinemáticos es a menudo calcular las funciones 
trascendentales (seno y coseno). Cuando estas funciones están disponibles como parte 
de una biblioteca estándar, a menudo se hacen a partir de una expansión de series, con 
el riesgo de ocupar muchas multiplicaciones. Muchos sistemas de manipulación (con el 
riesgo de requerir cierta cantidad de memoria) emplean implementaciones de búsque¬ 
da en tabla de las funciones trascendentales. Dependiendo del esquema, esto reduce la 
cantidad de tiempo requerido para calcular un seno o coseno a dos o tres multiplicacio¬ 
nes o menos [6]. 

El cálculo cinemático, como el mostrado en la ecuación (3.14), es redundante, ya 
que fue necesario calcular nueve cantidades para representar la orientación. Una ma¬ 
nera de reducir el trabajo es determinar sólo dos columnas de la matriz de rotación y 
luego determinar un producto cruz (el cual requiere solamente seis multiplicaciones 
y tres sumas) para determinar la tercera columna. Obviamente, se eligen las dos colum¬ 
nas menos complicadas para efectuar las operaciones matemáticas. 
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EJERCICIOS 

3.1 [15] Calcule la cinemática del brazo planar del ejemplo 3.3. 

3.3 [37] Imagine un brazo como el PUMA 560, excepto que se remplace la articulación 3 
con una articulación prismática. Suponga que la articulación prismática se desliza a lo 
largo de la dirección de Y, en la figura 3.18; no obstante, sigue habiendo un desplaza¬ 
miento equivalente a d 3 que se debe tener en cuenta. Haga todas las suposiciones adi¬ 
cionales necesarias. Derive las ecuaciones cinemáticas. 

3.3 [25] El brazo con tres grados de libertad que se muestra en la figura 3.29 es como el 
del ejemplo 3.3, excepto que el eje de la articulación 1 no es paralelo a los otros dos. 
En su lugar hay una torsión de 90 grados de magnitud entre los ejes 1 y 2. Derive los 
parámetros de vínculo y las ecuaciones cinemáticas para 5, T. Observe que no es nece¬ 
sario definir l 3 . 

3.4 [22] En el brazo con tres grados de libertad que se muestra en la figura 3.30, las articu¬ 
laciones 1 y 2 son perpendiculares y las articulaciones 2 y 3 son paralelas. Según lo ilus¬ 
trado, todas las articulaciones están en su ubicación cero. Observe que se indica el 
sentido positivo del ángulo de articulación. Asigne las tramas de vínculo de la {0} a la 
[3] para este brazo; esto es, haga un bosquejo del brazo mostrando la articulación de 
las tramas. Después derive las matrices de transformación °T,\Ty 3 T. 
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FIGURA 3.29: El brazo 3 R no planar (ejercicio 3.3). 



3.5 [26] Escriba una subrutina para calcular la cinemática de un PUMA 560. Codifique 
teniendo en cuenta la velocidad, tratando de minimizar el número de multiplicaciones 
lo más que sea posible. Use el siguiente encabezado de procedimiento (o su equiva¬ 
lente en C): 

Procedure CIN (VAR theta: vec6; VAR wrelb: trama); 

Cuente una evaluación de seno o coseno como 5 multiplicaciones. Considere las su¬ 
mas como 0.333 multiplicaciones y las instrucciones de asignación como 0.2 multipli- 
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caciones. Considere que el cálculo de una raíz cuadrada toma 4 multiplicaciones. 
¿Cuántas multiplicaciones necesita? 

3.6 [20] Escriba una subrutina para calcular la cinemática del brazo cilindrico del ejemplo 
3.4. Utilice el siguiente encabezado de procedimiento (o su equivalente en C): 

Procedure CIN(VAR varartic: vec3; VAR wrelb: trama); 

Cuente una evaluación de seno o coseno como 5 multiplicaciones. Considere las su¬ 
mas como 0.333 multiplicaciones y las instrucciones de asignación como 0.2 multipli¬ 
caciones. Cuente un cálculo de raíz cuadrada como 4 multiplicaciones. ¿Cuántas 
multiplicaciones necesita? 

3.7 [22] Escriba una subrutina para calcular la cinemática del brazo del ejercicio 3.3 Uti¬ 
lice el siguiente encabezado de procedimiento (o su equivalente en C): 

Procedure CIN(VAR theta: vec3; VAR wrelb: trama); 

Cuente una evaluación de seno o coseno como 5 multiplicaciones. Cuente las sumas 
como 0.333 multiplicaciones y las instrucciones de asignación como 0.2 multiplicacio¬ 
nes. Considere que el cálculo de una raíz cuadrada toma 4 multiplicaciones. ¿Cuántas 
multiplicaciones necesita? 

3.8 [13] En la figura 3.31 no se conoce la ubicación exacta de la herramienta ^T. Usando 
el control de fuerza, el robot siente los alrededores con la punta de la herramienta 
hasta que la inserta en el receptáculo (u objetivo) en la ubicación ^¡T. Una vez en es¬ 
ta configuración de “calibración” (en la que [G] y [T¡ son coincidentes), la posición 
del robot se averigua tomando lectura de los sensores de los ángulos de articula¬ 
ción y calculando la cinemática. Suponiendo que se conozcan y ¡5, T) proporcione la 
ecuación de transformadas para calcular la trama herramienta desconocida ™ T. 



FIGURA 3.31: Determinación de la trama herramienta (ejercicio 3.8). 
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Punta 



(a) (b) 

FIGURA 3.32: Brazo de dos vínculos con asignaciones de tramas (ejercicio 3.9). 


3.9 [11] Para el manipulador de dos vínculos que se muestra en la figura 3.32(a) se cons¬ 
truyeron las matrices de transformación de vínculos T y \ T. Su producto es: 


cdic9 2 
o s9¡ c9 2 
2 s9 2 

0 


—c9^s9 2 

—s9 1 s9 2 

c9 2 

0 


s9± lic9i 
—c9 1 / 1 s9 1 
0 0 

0 1 


Las asignaciones de trama de vínculo que se utilizan se indican en la figura 3.32(b). 
Observe que la trama [0¡ es coincidente con la trama ¡1) cuando 9 1 = 0. La longitud 
del segundo vínculo es Encuentre una expresión para el vector °P punta , el cual posi- 
ciona la punta del brazo con respecto a la trama [0¡. 

3.10 [39] Derive ecuaciones cinemáticas para el robot Yasukawa Motoman (vea la sección 
3.7) que calculan la posición y la orientación de la trama de la muñeca directamente 
de los valores de los actuadores, en vez de calcular primero los ángulos de articula¬ 
ción. Es posible encontrar una solución que requiera solamente de 33 multiplicacio¬ 
nes, dos raíces cuadradas y seis evaluaciones de senos o cosenos. 

3.11 [17] La figura 3.33 muestra el diagrama esquemático de una muñeca que tiene tres 
ejes perpendiculares que no son ortogonales. Asigne tramas de vínculos a esta muñe¬ 
ca (como si fuera un manipulador de tres grados de libertad o 3-DOF) y proporcione 
los parámetros de vínculos. 

3.12 [08] ¿Puede una transformación de cuerpo rígido arbitraria expresarse con cuatro pa¬ 
rámetros (a, a, d, 9) en la forma de la ecuación (3.6)? 

3.13 [15] Muestre la articulación de las tramas de vínculos para el manipulador de cinco 
grados de libertad o 5-DOF que se muestra esquemáticamente en la figura 3.34. 

3.14 [20] Como se dijo anteriormente, la posición relativa de dos líneas cualesquiera en el 
espacio puede proporcionarse mediante dos parámetros, a y a, en donde a es la lon¬ 
gitud de la perpendicular común que une las dos líneas y a es el ángulo formado por 
los dos ejes cuando se proyectan en un plano que sea normal a la perpendicular co¬ 
mún. Dada una línea que se define como la que pasa a través del punto p, con la di¬ 
rección del vector unitario m y una segunda línea que pasa a través del punto q con la 
dirección del vector unitario ñ , escriba expresiones para a ya. 

3.15 [15] Muestre la articulación de tramas de vínculos para el manipulador 3-DOF que se 
muestra esquemáticamente en la figura 3.35. 

3.16 [15] Asigne tramas de vínculos al robot planar RPR que se muestra en la figura 3.36 
y proporcione los parámetros de las articulaciones. 

3.17 [15] Muestre la articulación de tramas de vínculos en el robot de tres vínculos que se 
muestra en la figura 3.37. 
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FIGURA 3.33: Robot 3 R con eje no ortogonal (ejercicio 3.11). 



• 

/ \ 

/ \ 
/ \ 


FIGURA 3.34: Diagrama esquemático de un manipulador 2RP2R (ejercicio 3.13). 


3.18 [15] Muestre la articulación de tramas de vínculos en el robot de tres vínculos que se 
muestra en la figura 3.38. 

3.19 [15] Muestre la articulación de tramas de vínculos en el robot de tres vínculos que se 
muestra en la figura 3.39. 

3.20 [15] Muestre la articulación de tramas de vínculos en el robot de tres vínculos que se 
muestra en la figura 3.40. 

3.21 [15] Muestre la articulación de tramas de vínculos en el robot de tres vínculos que se 
muestra en la figura 3.41. 

3.22 [15] Muestre la articulación de tramas de vínculos en el robot de tres vínculos que se 
muestra en la figura 3.42. Dadas sus asignaciones de tramas, ¿cuáles son los signos de 
¿^ 2 , y 
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FIGURA 3.35: Diagrama esquemático de un manipulador 3 R (ejercicio 3.15). 


e 3 



FIGURA 3.36: Robot planar RPR (ejercicio 3.16). 



FIGURA 3.37: Manipulador RRP de tres vínculos (ejercicio 3.17). 
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FIGURA 3.38: Manipulador RRR de tres vínculos (ejercicio 3.18). 



FIGURA 3.39: Manipulador RPP de tres vínculos (ejercicio 3.19). 


di 



FIGURA 3.40: Manipulador PRR de tres vínculos (ejercicio 3.20). 
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FIGURA 3.42: Diagrama esquemático de un manipulador P3R (ejercicio 3.22). 



EJERCICIO DE PROGRAMACIÓN (PARTE 3) 

1. Escriba una subrutina para calcular la cinemática del robot 3R planar del ejemplo 3.3; 
es decir, una rutina con los valores de los ángulos de articulación como entrada, y una 
trama (la de muñeca relativa a la trama base) como salida. Use el siguiente encabeza¬ 
do de procedimiento (o su equivalente en C): 

Procedure CIN(VAR theta: vec3; VAR wrelb: trama); 

en donde “wrelb” es la trama de muñeca relativa a la trama base, ^ T. El tipo “trama” 
consiste de una matriz de rotación de 2 x 2 y un vector posición de 2 x 1. Si lo desea, 
puede representar la trama con una transformada homogénea de 3 x 3 en la que la 
tercera fila es [0 0 1], (Los datos del manipulador son l Y = l 2 = 0.5 metros). 
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2. Escriba una rutina que calcule en dónde está la herramienta respecto a la trama esta¬ 
ción. La entrada a la rutina debe ser un vector de ángulos de articulación: 

Procedure DONDE(VAR theta: vec3; VAR trels: trama); 

Obviamente, DONDE debe hacer uso de descripciones de la trama herramienta y la 
trama base del robot para poder calcular la ubicación de la herramienta, relativa a 
la trama estación. Los valores de Y^T y deben almacenarse en la memoria global 
(o, como segunda opción, pueden pasarse como argumentos en la rutina DONDE). 

3. El usuario define una trama herramienta y una trama estación para cierta tarea, co¬ 
mo se muestra a continuación: 

= [x y 0] = [0.1 0.2 30.0], 

= [.v y 0] = [—0.1 0.3 0.0]. 

Calcule la posición y la orientación de la herramienta respecto a la trama estación pa¬ 
ra las siguientes tres configuraciones del brazo (en unidades de grados): 

\0 } d 2 <%] = [0.0 90.0 - 90.0], 

[0 X d 2 0 3 \ = [-23.6 - 30.3 48.0], 

16 », e 2 e 3 ] = [130.0 40.0 12 .O]. 

EJERCICIO MATLAB 3 

Este ejercicio se enfoca en los parámetros DLI y en el planteamiento directo de la transfor¬ 
mación cinemática (posición y orientación) para el robot de 3 grados de libertad, o 3-DOF, 
3R planar (de las figuras 3.6 y 3.7). Se proporcionan los siguientes parámetros de longitud 
fija: Lj = 4 , L 2 = 3 y L 3 = 2 (m). 

a) Evalúe los parámetros DH. Puede comprobar sus resultados con la figura 3.8. 

b) Evalúe las matrices de transformación homogéneas adyacentes 1 \T, i = 1, 2, 3, las 
cuales son funciones de las variables de ángulo de articulación 9¡, i = 1, 2, 3. Además, 
evalúe la constante ¿ T por inspección: el origen de {//} está en el centro de los dedos 
de la herramienta de sujeción y la orientación de (//} es siempre la misma que la orien¬ 
tación de ¡3). 

c) Use el software Symbolic MATLAB para determinar la solución cinemática de plantea¬ 
miento directo 3 T y simbólicamente (como una función de 9¡). Abrevie su respuesta 
usando s¡ = sen (9¡), c¡ = eos(0.), y así sucesivamente. Además hay una simplificación de 
(9 ] + 9 2 + 9 3 ) mediante el uso de fórmulas de la suma de ángulos, esto debido a los ejes 
Z ¡ paralelos. Calcule los resultados de cinemática de planteamiento directo (tanto 3 T co¬ 
mo ° h T) mediante MATLAB para los siguientes casos de entrada: 

i) @ = {6» i e 2 6» 3 } :r ={0 0 0} 7 '. 

ii) 0 = {Í0° 20° 30°] r . 

iii) 0 = {90° 90° 90°} r . 

Para los tres casos, compruebe sus resultados con un bosquejo de la configuración del 
manipulador y determinando la transformación cinemática de planteamiento directo 
por inspección. (Piense en la definición de ° H T en términos de una matriz de rotación 
y un vector posición.) Incluya las tramas {//), {3} y {0} en sus bosquejos. 

d) Compruebe todos sus resultados mediante la Caja de Herramientas de Robótica MA¬ 
TLAB de Corke. Pruebe las funciones link {), robotQ y fkine('). 
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4.1 INTRODUCCIÓN 

En el capítulo 3 consideramos el problema de calcular la posición y la orientación de la 
herramienta respecto a la estación de trabajo del usuario cuando se proporcionan los 
ángulos de articulación del manipulador. En este capítulo investigaremos el problema 
converso, más difícil: dada la posición y orientación deseadas de la herramienta respec¬ 
to a la estación, ¿cómo calculamos el conjunto de ángulos de articulación que logren es¬ 
te resultado deseado? Mientras que el capítulo 3 trató sobre la cinemática directa de 
los manipuladores, aquí el énfasis será en la cinemática inversa de los mismos. 

La manera de resolver el problema de encontrar los ángulos de articulación re¬ 
queridos para colocar la trama herramienta {Tj relativa a la trama estación {.S'¡ se divide 
en dos partes. Primero se realizan transformaciones de trama para encontrar la trama 
de la muñeca {W} relativa a la trama base \fí\. y después se utiliza cinemática inversa 
para resolver los ángulos de articulación. 

4.2 SOLUBILIDAD 

El problema de resolver las ecuaciones cinemáticas de un manipulador es no lineal. Da¬ 
do el valor numérico de ”, T, tratamos de encontrar valores de 6 V 0 2 , ..., 0 . Considere 
las ecuaciones en (3.14). En el caso del manipulador PUMA 560, la declaración precisa 
de nuestro problema actual sería la siguiente: dada 5 T como 16 valores numéricos 
(cuatro de los cuales son triviales), resuelva (3.14) para los seis ángulos de articulación 

e i al de¬ 
para el caso de un brazo con seis grados de libertad (como el que corresponde a 

las ecuaciones en (3.14)), tenemos 12 ecuaciones y seis variables desconocidas. No obs¬ 
tante, entre las nueve ecuaciones que surgen de la porción de la matriz de rotación de 
° T, sólo tres son independientes. Estas, agregadas a las tres ecuaciones de la porción 
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del vector de posición de ° T, proporcionan seis ecuaciones con seis variables desconoci¬ 
das. Estas ecuaciones son no lineales y trascendentales, por lo cual pueden ser bastante 
difíciles de resolver. Las ecuaciones de (3.14) son las de un robot que tiene parámetros de 
vínculo muy simples; muchas de las a ¡ son 0 o ±90 grados. Muchos desplazamientos 
de vínculo y longitudes son cero. Es fácil imaginar que, para el caso del mecanismo gene¬ 
ral con seis grados de libertad (con todos los parámetros de vínculo distintos de cero), las 
ecuaciones cinemáticas serían mucho más complejas que las de (3.14). Al igual que con 
cualquier conjunto no lineal de ecuaciones, debemos preocuparnos por la existencia de 
soluciones, por los casos con soluciones múltiples y por el método de solución. 

Existencia de soluciones 

La pregunta de si existe alguna solución hace que surja otra sobre el espacio de traba¬ 
jo del manipulador. En general, el espacio de trabajo es el volumen de espacio que pue¬ 
de ser alcanzado por el efector final del manipulador. Para que exista una solución el 
punto de destino debe estar dentro del espacio de trabajo. Algunas veces es útil consi¬ 
derar dos definiciones sobre el espacio de trabajo: espacio de trabajo diestro es el 
volumen de espacio que puede alcanzar el efector final del robot con todas las orienta¬ 
ciones; esto es, en cada punto del espacio de trabajo diestro, el efector final puede 
orientarse arbitrariamente. El espacio de trabajo alcanzable es el volumen de espacio 
que puede alcanzar el robot en por lo menos una orientación. Evidentemente, el espa¬ 
cio de trabajo diestro es un subconjunto del espacio de trabajo alcanzable. 

Considere el espacio de trabajo del manipulador de dos vínculos en la figura 4.1. 
Si — 1 2 , entonces el espacio de trabajo alcanzable consiste en un disco de radio 2 l v El 
espacio de trabajo diestro consiste de un solo punto, el origen. Si ± l 2 , entonces no 
hay espacio de trabajo diestro y el espacio de trabajo alcanzable se convierte en un ani¬ 
llo con un radio exterior de I l + l 2 y un radio interior de \I l — ¡ 2 \. Dentro del espacio de 
trabajo alcanzable hay dos posibles orientaciones del efector final. En los límites del es¬ 
pacio de trabajo sólo hay una orientación posible. 

Estas consideraciones de espacio de trabajo para el manipulador de dos vínculos 
suponen que todas las articulaciones pueden girar 360 grados. Esto raras veces es cierto 
para los mecanismos reales. Cuando los límites de las articulaciones son un subconjun¬ 
to de los 360 grados completos, es obvio que el espacio de trabajo se reduce en forma 
correspondiente, ya sea en extensión o en el número de orientaciones posibles que pue- 



FIGURA 4.1: Manipulador de dos vínculos con longitudes de vínculo l 1 y l T 
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dan obtenerse. Por ejemplo, si el brazo de la figura 4.1 tiene un movimiento de 360 gra¬ 
dos para 0 V pero sólo 0 < 0 2 < 180°, entonces el espacio de trabajo alcanzable tiene la 
misma extensión pero sólo puede obtenerse una orientación en cada punto. 

Cuando un manipulador tiene menos de seis grados de libertad, no puede alcan¬ 
zar posiciones y orientaciones para un destino arbitrario en espacio 3D. Evidentemente 
el manipulador planar de la figura 4.1 no puede salirse del plano, por lo que cualquier 
punto de destino con un valor de coordenada Z distinto de cero puede rechazarse rá¬ 
pidamente como inalcanzable. En muchas situaciones realistas se emplean manipula¬ 
dores con cuatro o cinco grados de libertad que operan fuera de un plano, pero que 
evidentemente no pueden alcanzar destinos arbitrarios. Cada uno de esos manipulado¬ 
res debe estudiarse para comprender su espacio de trabajo. En general, el espacio de 
trabajo de dicho robot es un subconjunto de un subespacio que puede asociarse con 
cualquier robot en particular. Dada una especificación de trama de destino general, sur¬ 
ge un problema interesante en relación con los manipuladores que tienen menos de seis 
grados de libertad: ¿cuál es la trama de destino más cercana que puede obtenerse? 

El espacio de trabajo también depende de la transformación de la trama herra¬ 
mienta, ya que generalmente es la punta de la herramienta sobre la que se discute cuan¬ 
do hablamos de puntos alcanzables en el espacio. En general la transformación de la 
herramienta se realiza de manera independiente de las cinemáticas directa e inversa del 
manipulador, por lo que a menudo tenemos que considerar el espacio de trabajo de la 
trama de la muñeca, { W}. Para un efector final dado se define una trama herramienta {7 ¡: 
dada una trama de destino ¡Gj se calcula la trama {W} correspondiente y después pre¬ 
guntamos: ¿esta posición y orientación deseadas de { W] se encuentran en el espacio de 
trabajo? De esta manera, el espacio de trabajo en el que debemos concentrarnos (en 
sentido computacional) es distinto del que imagina el usuario, que está concentrado 
en el espacio de trabajo del efector final (la trama {T¡). 

Si la posición y orientación deseadas de la trama de la muñeca se encuentran en 
el espacio de trabajo, entonces existe por lo menos una solución. 

Múltiples soluciones 

Otro posible problema que nos encontramos al resolver ecuaciones cinemáticas es el de 
múltiples soluciones. Un brazo planar con tres articulaciones angulares tiene un espa¬ 
cio de trabajo diestro en el plano extenso (dadas unas “buenas” longitudes de vínculo 
y rangos de articulación extensos), ya que cualquier posición en el interior de su espa¬ 
cio de trabajo puede alcanzarse con cualquier orientación. La figura 4.2 muestra un 



FIGURA 4.2: Manipulador de tres vínculos. Las líneas punteadas indican una segunda 
solución. 
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FIGURA 4.3: Una de las dos posibles soluciones para llegar al punto B produce una colisión. 

brazo planar de tres vínculos con su efector final en cierta posición y orientación. Las 
líneas punteadas indican una segunda configuración posible en la que puede lograrse la 
misma posición y orientación del efector final. 

El hecho de que un manipulador tenga múltiples soluciones puede ocasionar pro¬ 
blemas, ya que el sistema tiene que ser capaz de elegir una. Los criterios sobre los que 
debe basarse una decisión varían, pero una elección muy razonable sería la solución 
más cercana. Por ejemplo, si el manipulador se encuentra en el punto A, como en la fi¬ 
gura 4.3, y deseamos moverlo al punto B , una buena elección sería la solución que mi¬ 
nimiza la cantidad que se requiere mover cada articulación. Por lo tanto, en la ausencia 
del obstáculo se elegiría la configuración superior marcada con líneas punteadas en la 
figura 4.3. Esto sugiere que un argumento de entrada para nuestro procedimiento cine¬ 
mático inverso podría ser la posición actual del manipulador. De esta manera, si hay una 
opción, nuestro algoritmo puede elegir la solución más cercana en espacio de articula¬ 
ción. No obstante, la noción de “cercano” podría definirse de varias formas. Por ejem¬ 
plo, los robots comunes podrían tener tres vínculos extensos seguidos de tres vínculos de 
orientación más pequeños cerca del efector final. En este caso podría aplicarse una pon¬ 
deración en el cálculo de cuál solución es “más cercana”, de manera que la selección fa¬ 
voreciera las articulaciones móviles más pequeñas, en vez de mover las articulaciones 
grandes, cuando exista una opción. La presencia de obstáculos podría forzar la elección 
de una solución “más lejana” en casos en los que la solución “cercana” produjera una co¬ 
lisión; entonces, en general necesitamos poder calcular todas las soluciones posibles. Por 
lo anterior, en la figura 4.3 la presencia del obstáculo implica que se va a utilizar la confi¬ 
guración marcada con las líneas punteadas inferiores para llegar al punto B. 

El número de soluciones depende del número de articulaciones en el manipulador, 
pero también es una función de los parámetros de vínculo (a¡, a¡ y d¡ para un manipula¬ 
dor con articulación giratoria) y los rangos de movimiento permisibles de las articulaciones. 
Por ejemplo, el PUMA 560 puede llegar a ciertos destinos con ocho soluciones distintas. La 
figura 4.4 muestra cuatro soluciones; todas colocan la mano con la misma posición y orien¬ 
tación. Para cada solución descrita existe otra solución en la que las últimas tres articulacio¬ 
nes se cambian a una configuración alterna, de acuerdo con las siguientes fórmulas: 

0 ' =d 4 +180°, 

0' = -0 5 , (4-1) 

0 ' = é> 6 + 180°. 

Por lo tanto, en total puede haber ocho soluciones para un solo destino. Debido a los lí¬ 
mites sobre los rangos de articulación algunas de estas soluciones podrían ser inaccesibles. 
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FIGURA 4.4: Cuatro soluciones para el PUMA 560. 


En general, entre más parámetros de vínculo distintos de cero haya, más formas 
habrá de llegar a un cierto destino. Por ejemplo, considere un manipulador con seis ar¬ 
ticulaciones giratorias. La figura 4.5 muestra cómo se relaciona el máximo número de 
soluciones con el número de los parámetros de longitud de vínculo (a.) que son cero. 
Entre más parámetros sean distintos de cero, mayor será el máximo número de solu¬ 
ciones. Para un manipulador general de seis grados de libertad con articulaciones gira¬ 
torias, hay hasta 16 soluciones posibles [1,6]. 

Método de solución 

A diferencia de las ecuaciones lineales, no hay algoritmos generales que puedan emplear¬ 
se para resolver un conjunto de ecuaciones no lineales. Al considerar métodos de solu¬ 
ción, es conveniente definir lo que constituye la “solución” de un manipulador dado. 

Se considerará que un manipulador tiene solución si las variables de articulación 
pueden determinarse mediante un algoritmo que nos permita determinar todos los con¬ 
juntos de variables de articulación asociados con una posición y orientación dadas [2]. 
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0¡ 

Número de soluciones 

ci\ — «3 = «5 = 0 

4 

a 3 = a 5 = 0 

ss 8 

«3=0 

SS 16 

Todas las «¡ ^ 0 

SS 16 


FIGURA 4.5: Comparación entre el número de soluciones y los valores de a ¡ distintos de 
cero. 


El punto principal de esta definición es que, en el caso de múltiples soluciones, re¬ 
querimos que sea posible calcular todas las soluciones. Por lo tanto, no consideramos que 
ciertos procedimientos iterativos numéricos resuelvan el manipulador en la medida en 
que no se garantiza que esos métodos encuentren todas las soluciones. 

Dividiremos todas las estrategias de solución de manipuladores propuestas en dos 
clases amplias: soluciones de forma cerrada (analíticas) y soluciones numéricas. Debi¬ 
do a su naturaleza iterativa, las soluciones numéricas son generalmente mucho más len¬ 
tas que la solución de forma cerrada correspondiente; de hecho, son tan lentas que para 
casi todos los fines no estaremos interesados en el enfoque numérico para la solución 
de problemas cinemáticos. La solución iterativa numérica para las ecuaciones cinemá¬ 
ticas es todo un campo de estudio en sí (vea [6,11,12]) y se encuentra más allá del al¬ 
cance de este texto. 

Restringiremos nuestra atención a los métodos de solución de forma cerrada. En 
este contexto, “forma cerrada” significa un método de solución basado en expresiones 
analíticas o en la solución de un polinomio de grado 4 o menor, de tal forma que basta 
con los cálculos no iterativos para llegar a una solución. Dentro de la clase de solucio¬ 
nes de forma cerrada, distinguimos dos métodos para obtener la solución: algebraico y 
geométrico. Estas distinciones son algo confusas: cualquier método geométrico a con¬ 
siderar se aplica por medio de expresiones algebraicas, por lo que los dos métodos son si¬ 
milares. Los métodos tal vez difieren sólo en el enfoque. 

Un importante resultado reciente en cinemática es que, de acuerdo con nuestra 
definición de solubilidad, todos los sistemas con articulaciones angulares y prismáticas 
que tengan un total de seis grados de libertad en una sola cadena en serie pueden resol¬ 
verse. No obstante, esta solución general es numérica. Sólo en casos especiales los ro¬ 
bots con seis grados de libertad pueden resolverse analíticamente. Estos robots para los 
que existe una solución analítica (o de forma cerrada) se caracterizan ya sea por tener 
varios ejes de articulación perpendiculares o muchas a¡ iguales a 0 o ±90 grados. Ge¬ 
neralmente el cálculo de soluciones numéricas consume mucho tiempo cuando se le 
compara con la evaluación de expresiones analíticas; por lo tanto, se considera muy im¬ 
portante diseñar un manipulador de manera que exista una solución de forma cerrada. 
Los diseñadores de manipuladores descubrieron esto muy pronto, por lo que ahora 
casi todos los manipuladores industriales están diseñados con la suficiente simplicidad 
como para que pueda desarrollarse una solución de forma cerrada. 

Una condición suficiente para que un manipulador con seis articulaciones angu¬ 
lares tenga una solución de forma cerrada, es que tres ejes de articulación adyacentes 
se intersequen en un punto. En la sección 4.6 hablaremos sobre esta condición. Casi to¬ 
dos los manipuladores con seis grados de libertad construidos actualmente tienen tres 
ejes que se intersecan. Por ejemplo, los ejes 4, 5 y 6 del PUMA 560 se intersecan. 
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4.3 LA NOCIÓN DE SUBESPACIO DE MANIPULADOR CUANDO N <6 

El conjunto de tramas de destino alcanzables para un manipulador dado constituye su 
espacio de trabajo alcanzable. Para un manipulador con n grados de libertad (en don¬ 
de n < 6), este espacio de trabajo alcanzable puede considerarse como una porción de 
un subespacio con n grados de libertad. De la misma forma en que el espacio de traba¬ 
jo de un manipulador con seis grados de libertad es un subconjunto del espacio, el 
espacio de trabajo de un manipulador más simple es un subconjunto de su subespacio. 
Por ejemplo, el subespacio del robot de dos vínculos de la figura 4.1 es un plano, pero 
el espacio de trabajo es un subconjunto de este plano; es decir, un círculo de radio /j + l 2 
para el caso en que — l T 

Una manera de especificar el subespacio de un manipulador con n grados de li¬ 
bertad es proporcionar una expresión para su trama de muñeca o de herramienta, co¬ 
mo función de n variables que la posicionan. Si consideramos que estas n variables son 
libres, entonces, a medida que vayan tomando todos los valores posibles, se generará 
el subespacio. 


EJEMPLO 4.1 

Proporcione una descripción del subespacio de ^ T para el manipulador de tres víncu¬ 
los de la figura 3.6. 

El subespacio de ^ T se da mediante 



' c 0 


0.0 

X 

B ’j 1 _ 

s * 


0.0 

y 

W ~ 

0.0 

0.0 

1.0 

O 

O 


0 

0 

0 

i 


(4.2) 


en donde x y y proporcionan la posición de la muñeca y (p describe la orientación del 
vínculo terminal. A medida que se permite a x, y y </> tomar valores arbitrarios, se gene¬ 
ra el subespacio. Cualquier trama de muñeca que no tenga la estructura de (4.2) se en¬ 
cuentra fuera del subespacio (y por lo tanto queda fuera del espacio de trabajo) de este 
manipulador. Las longitudes de los vínculos y los límites de las articulaciones restringen 
el espacio de trabajo del manipulador para que sea un subconjunto de este subespacio. 


_ ^ _ 

F=n , - 

i/ 

' 

¿O- 3 -^ 

' 


FIGURA 4.6: Un manipulador polar de dos vínculos. 
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EJEMPLO 4.2 

Proporcione una descripción del subespacio de 2 T para el manipulador polar con dos 
grados de libertad que se muestra en la figura 4.6. Tenemos que 


o 


P 2ORG ~ 


X 

y , 

o 


(4.3) 


en donde xy y pueden tomar cualquier valor. La orientación está restringida ya que el 
eje °Z 7 debe apuntar en una dirección que dependa de x y y. El eje °Y 2 debe apuntar 
siempre hacia abajo, y el eje °X 2 puede calcularse como el producto cruz de °Y 7 x °Z 2 . 
En términos de x y y tenemos que 


o 


X 


\/* 2 + y 2 
y 

yj x 2 + y 2 

0 


(4.4) 


El subespacio puede por lo tanto darse como 


o 

2 


T = 


Jx 2 + V 2 Jx 2 + V 2 

-* n y 

—;=^= 0 . y 

a /x 2 +y 2 \¡ x 2 + y 2 

0-100 
0 0 0 1 


(4.5) 


Casi siempre, al definir un destino u objetivo para un manipulador con n grados 
de libertad, utilizamos n parámetros para especificar el destino. Si, por otra parte, pro¬ 
porcionamos una especificación de seis grados completos de libertad, no podremos en 
general alcanzar el destino con un manipulador n <6. En este caso, podría ser conve¬ 
niente alcanzar mejor un destino que se encuentre en el subespacio del manipulador y 
que esté lo más “cercano” posible al destino original deseado. 

Por ende, al especificar destinos generales para un manipulador con menos de seis 
grados de libertad, una estrategia de solución es la siguiente: 

L Dada una trama de destino general ¿ T. calcule una trama de destino modificada 
gT de tal manera que qT se encuentre en el subespacio del manipulador y esté lo 
más “cerca posible” de T. Debe elegirse una definición de “cerca”. 

2. De tal manera la cinemática inversa para encontrar los ángulos de articulación 
utilizando £, T como el destino deseado. Considere que tal vez no sería posible 
tener aún una solución si el punto de destino no se encuentra en el espacio de tra¬ 
bajo del manipulador. 

Casi siempre tiene sentido posicionar el origen de la trama herramienta en la ubi¬ 
cación deseada y luego seleccionar una orientación que pueda obtenerse y que esté cer¬ 
ca de la orientación deseada. Como vimos en los ejemplos 4.1 y 4.2, el cálculo del 
subespacio depende de la geometría del manipulador. Cada manipulador debe consi¬ 
derarse de manera individual para llegar a un método que realice este cálculo. 
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La sección 4.7 nos da un ejemplo de cómo proyectar un objetivo general en el sub¬ 
espacio de un manipulador con cinco grados de libertad para calcular los ángulos de ar¬ 
ticulación que hagan que el manipulador llegue a la trama más cercana a la deseada. 

4.4 COMPARACIÓN DE LOS ENFOQUES ALGEBRAICO Y GEOMÉTRICO 

Como introducción a la solución de ecuaciones cinemáticas consideraremos dos méto¬ 
dos distintos para la solución de un manipulador planar simple de tres vínculos. 

Solución algebraica 

Considere el manipulador planar de tres vínculos que se presentó en el capítulo 3. Se 
muestra con sus parámetros de vínculo en la figura 4.7. 

Si seguimos el método del capítulo 3 podemos usar los parámetros de vínculo fá¬ 
cilmente para encontrar las ecuaciones cinemáticas de este brazo: 


c 123 

lS 123 

O 

O 

h c l + l 2 c l2 

■*123 

c 123 

o 

o 

h s i + h s \2 

0.0 

0.0 

1.0 

0.0 

0 

0 

0 

1 


(4.6) 


Yí 


i 

a¡ - 1 

a¿ - 1 

d¡ 

di 
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0 

0 

0 

01 

2 

0 

¿1 

0 

02 

3 

0 

^2 

0 

03 



FIGURA 4.7: Manipulador planar de tres vínculos y sus parámetros correspondientes. 
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Para enfocar nuestra discusión en la cinemática inversa, vamos a suponer que se han 
realizado las transformaciones necesarias, de manera que el punto de destino sea una 
especificación de la trama de muñeca relativa a la trama base, la cual es ^T. Como es¬ 
tamos trabajando con un manipulador planar, puede lograrse la especificación de estos 
puntos de destino muy fácilmente, especificando tres números: x,yy<¡>, en donde 0 es 
la orientación del vínculo 3 en el plano (relativo al eje +X). Así, en vez de proporcio¬ 
nar una /?, T general como especificación de un destino, supondremos una transforma¬ 
ción con la siguiente estructura: 


B 

IV 


T = 


~ s 4> * 

0.0 y 

0.0 0.0 1.0 0.0 
0 0 0 1 


(4.7) 


Todos los destinos alcanzables deben encontrarse en el subespacio implicado por la es¬ 
tructura de la ecuación (4.7). Al igualar (4.6) y (4.7) llegamos a un conjunto de cuatro 
ecuaciones no lineales que deben resolverse para 6 V 6 2 y 

c 0 = c 123’ (4.8) 

s <¡> = *123’ (4.9) 

* = h c i + h c i2’ (4-10) 

y = h s i + i 2 s i2- (4.ii) 

Ahora comenzaremos nuestra solución algebraica de las ecuaciones (4.8) a la (4.11). 
Si elevamos al cuadrado las ecuaciones (4.10) y (4.11) y las sumamos, obtendremos: 

x 2 + y 2 = l 2 + /“ + 2Iyl 2 c 2 , (4.12) 

en donde habremos hecho uso de 

c 12 = c l c 2 _ í l í 2’ 

S 12 = c \ s 2 + S\C 2 . (4.13) 


Resolviendo (4.12) para c 2 , obtendremos: 


x 2 + y 2 


l 2 -H 


2 U 


1'2 


(4.14) 


Para que pueda existir una solución, el lado derecho de (4.14) debe tener un va¬ 
lor entre —1 y 1. En el algoritmo de solución, esta restricción se comprobaría en este 
momento para averiguar si existe una solución. Físicamente, si esta restricción no se sa¬ 
tisface, entonces el punto de destino está demasiado lejos como para que el manipula¬ 
dor lo alcance. 

Suponiendo que el destino está en el espacio de trabajo, escribimos una expresión 
para s 2 de la siguiente manera: 

* 2 =(4.i5) 

Por último, calculamos 0 2 con la rutina de arco tangente de dos argumentos: 1 

0 2 = Atan2(s 2 , c 2 ). (4.16) 


1 Vea la sección 2.8. 
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Esta opción de signos en la ecuación (4.15) corresponde a la solución múltiple en la que 
podemos elegir la solución de “codo hacia arriba” o de “codo hacia abajo”. Para deter¬ 
minar 0 2 hemos usado uno de los métodos recurrentes para resolver el tipo de relaciones 
cinemáticas que surgen con más frecuencia: determinar tanto el seno como el coseno 


del ángulo de articulación deseado y luego aplicar la función arco tangente de dos ar¬ 
gumentos. Esto asegura que encontremos todas las soluciones y que el ángulo resuelto 
se encuentre en el cuadrante apropiado. 

Después de encontrar podemos resolver las ecuaciones (4.10) y (4.11) para 6 V 
Escribimos (4.10) y (4.11) de la siguiente forma: 

x = Aq C\ — k 2 s±, 

(4.17) 

y = k 1 s 1 +k 2 c 1 , 

(4.18) 

en donde 


h = h + l 2 c 2> 

k-2 = h s 2- 

(4.19) 

Para poder resolver una ecuación de esta forma realizamos un cambio de variables. En 
realidad estamos cambiando la forma en que escribimos las constantes Aq y k r 

Si 

r = +Jk^ + k | 

(4.20) 

y 

y — Atan2(A 2 , Aq), 


entonces 


Aq = r eos y, 

k 2 — r sen y. 

(4.21) 

Las ecuaciones (4.17) y (4.18) pueden ahora escribirse así: 


— = eos y eos 0 1 — sen y sen 0 1 , 

(4.22) 

V 

— = eos y sen 0 1 + sen y eos 0 1 , 

(4.23) 

por lo tanto 


X 

cos(y + 0i) = -, 
r 

(4.24) 

sen(y + e x ) = 

r 

(4.25) 

Usando el arreglo de dos argumentos, obtenemos 


y + 6 l — Atan2 ^ —^ = Atan2(y, x). 

(4.26) 

y, por lo tanto 


6 l — Atan2(y, x) — Atan2(A: 2 , Aq). 

(4.27) 
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Observe que cuando se elige un signo en la solución de 0 2 descrita anteriormente, se 
provoca un cambio de signo en k 2 , lo cual afecta a 8 y Las sustituciones (4.20) y (4.21) uti¬ 
lizadas constituyen un método de solución de una forma que aparece frecuentemente en 
cinemática: la de las ecuaciones (4.10) o (4.11). Observe también que si x = y = 0, enton¬ 
ces la ecuación (4.27) se vuelve indefinida y, en este caso, el valor de 9 1 es arbitrario. 

Finalmente, de las ecuaciones (4.8) y (4.9) podemos resolver para la suma de 9 l a 9¿ 


@1 + 0 2 + &?, — Atan2(s¿, cj — <¡>. 


(4.28) 


De este resultado, podemos despejar ya que conocemos los primeros dos án¬ 
gulos. Es común con los manipuladores que tienen dos o más vínculos que se mueven 
en un plano que, en el curso de la solución, surjan expresiones para las sumas de los án¬ 
gulos de articulación. 

En resumen, un método algebraico para resolver ecuaciones cinemáticas es bási¬ 
camente el de manipular las ecuaciones dadas en una forma para la cual se conozca una 
solución. Resulta que para muchas geometrías comunes con frecuencia surgen varias 
formas de ecuaciones trascendentales. Fiemos encontrado un par de ellas en la sección 
anterior. (En el apéndice C se muestran más de estas ecuaciones). 

Solución geométrica 

En un método geométrico para encontrar la solución de un manipulador, tratamos de 
descomponer la geometría espacial del brazo en varios problemas de geometría plana. 
Para muchos manipuladores (especialmente cuando las a. = 0 o ±90), esto puede ha¬ 
cerse con mucha facilidad. Los ángulos de articulación pueden así resolverse utilizando 
las herramientas de la geometría plana [7]. Para el brazo con tres grados de libertad que 
se muestra en la figura 4.7, como dicho brazo es planar podemos aplicar directamente 
la geometría plana para encontrar una solución. 

La figura 4.8 muestra el triángulo formado por / p l 2 y la línea que une el origen de 
la trama ¡0) con el origen de la trama ¡3). Las líneas punteadas representan otra posible 
configuración del triángulo, la cual llevaría a la misma posición de la trama ¡3). Conside¬ 
rando el triángulo sólido, podemos aplicar la “ley de los cosenos” y resolver para 9 2 . 



2/,/ 2 cos(180 ± 0 2 ). 


(4.29) 


'///, 



FIGURA 4.8: Geometría plana asociada con un robot planar de tres vínculos. 
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Ahora; cos(180 + 9 2 ) — —eos (0 2 ), por lo que tenemos: 


c 2 = 


+ .v 2 - 1 \ 

21.li 



(4.30) 


Para que este triángulo exista, la distancia al punto de destino \/ x 1 + y 2 debe ser me¬ 
nor o igual que la suma de las longitudes de los vínculos, l, + l 2 . Esta condición se com¬ 
probaría en este punto en un algoritmo computacional para verificar la existencia de 
soluciones. Esta condición no se satisface cuando el punto de destino está fuera del al¬ 
cance del manipulador. Suponiendo que exista una solución, esta ecuación se resuelve 
para aquel valor de 0 2 que se encuentre entre 0 y —180 grados, ya que sólo para estos 
valores existe el triángulo en la figura 4.8. La otra posible solución (la que está indica¬ 
da por el triángulo de líneas punteadas) se encuentra por simetría como 0' 2 — —0 2 - 

Para despejar 9, encontramos expresiones para los ángulos i/r y según lo indi¬ 
cado en la figura 4.8. En primer lugar puede estar en cualquier cuadrante, depen¬ 
diendo de los signos de a: y de y. Por ello debemos usar una función arco tangente de 
dos argumentos: 


P = Atan2(y, x). 


(4.31) 


De nuevo aplicamos la ley de los cosenos para encontrar \¡r. 


eos l/r = 


x 2 + y 2 + l 2 — l 2 
21,x 2 + y 2 


(4.32) 


Aquí el arco coseno debe resolverse de manera que 0 < t/ r < 180°, para poder preservar la 
geometría que nos lleve a la ecuación (4.32). Estas consideraciones son típicas cuando se 
utiliza un método geométrico; debemos aplicar las fórmulas que derivamos solamente so¬ 
bre un rango de variables tal que se preserve la geometría. Entonces tenemos que: 


e, = p±f. 


(4.33) 


en donde se utiliza el signo positivo si d 7 < 0 y el signo negativo si f) 2 > 0. 

Sabemos que los ángulos en un plano se suman, por lo que la suma de los tres án¬ 
gulos de articulación debe ser la orientación del último vínculo: 

9, + 0 2 + 9 3 = </>• (4-34) 

Esta ecuación se resuelve para 9 3 , para completar nuestra solución. 


4.5 SOLUCIÓN ALGEBRAICA POR REDUCCIÓN A POLINOMIO 


Las ecuaciones trascendentales son a menudo difíciles de resolver porque, aun y cuan¬ 
do solamente hay una variable (digamos, 9), generalmente aparece como sen 9 y eos 9. 
No obstante, si hacemos las siguientes sustituciones se produce una expresión en térmi¬ 
nos de una sola variable u: 



eos 9 = 


1 — u 2 
1 + u 2 ’ 


send = 


2 u 

1 + u 2 


(4.35) 
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Ésta es una sustitución geométrica muy importante que se utiliza a menudo para 
resolver ecuaciones cinemáticas. Estas sustituciones convierten ecuaciones trascen¬ 
dentales en ecuaciones polinomiales en u. El apéndice A contiene una lista de éstas y 
otras identidades trigonométricas. 


EJEMPLO 4.3 

Convierta la ecuación trascendental 

a eos 9 + b sen0 = c (4.36) 

en una ecuación polinomial en la tangente del medio ángulo, y resuelva para 9. 
Sustituyendo de la ecuación (4.35) y multiplicando por 1 + u 2 , tenemos que 

a(l-u 2 ) + 2bu = c(l + u 2 ). (4.37) 

Si juntamos las potencias de u tenemos que 

(o + c)u 2 — 2 bu + (c — a) — 0, (4.38) 

que se resuelve mediante la fórmula cuadrática: 

h i \/h 2 -4- ci 2 — c 2 

u = V + . (4.39) 

a + c 


Por lo tanto, 


9 — 2 tan 1 


/ b ± \/b 2 + a 2 — c 2 \ 
y a + c I 


(4.40) 


En caso de que la solución para u en base a la ecuación (4.39) fuera compleja, no hay 
solución real para la ecuación trascendental original. Observe que si a + c — 0, el argu¬ 
mento del arco tangente se vuelve infinito y por ende 9 = 180°. En una implementación 
por computadora debe comprobarse antes esta división potencial entre cero. Esta si¬ 
tuación se produce cuando el término cuadrático de (4.38) desaparece, de manera que 
la ecuación cuadrática se degenera en una ecuación lineal. 


Los polinomios de hasta cuarto grado poseen soluciones de forma cerrada [8, 9], 
por lo que los manipuladores que sean lo suficientemente simples como para poder re¬ 
solverse mediante ecuaciones algebraicas de este grado (o menores) se llaman manipu¬ 
ladores con solución de forma cerrada. 


4.6 SOLUCIÓN DE PIEPER CUANDO SE INTERSECAN TRES EJES 

Como se mencionó anteriormente, aunque un robot completamente general con seis 
grados de libertad no tenga una solución de forma cerrada, pueden resolverse ciertos 
casos especiales importantes. Pieper [3, 4] estudió los manipuladores con seis grados de 
libertad en los cuales tres ejes consecutivos se intersecan en un punto. 2 En esta sección 
describiremos el método que él desarrolló para el caso de las seis articulaciones angula¬ 
res, en donde los últimos tres ejes se intersecan. Su método se aplica a otras configura¬ 
ciones que incluyen articulaciones prismáticas, por lo que el lector interesado debería 

2 En esta familia de manipuladores se incluyen los que tienen tres ejes paralelos consecutivos, ya que se 
encuentran en el punto que está en el infinito. 
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leer la referencia [4]. El trabajo de Pieper se aplica a la mayoría de los robots industria¬ 
les comercialmente disponibles. 

Cuando se intersecan los últimos tres ejes, los orígenes de las tramas de vínculo 
¡4}, {5} y { 6 } se ubican en este punto de intersección, el cual se da en coordenadas base 
de la siguiente manera: 


x 


0 r) _ Ot 1 I 71 3 n _ 

M ORG ~ i 1 2 1 3 r 40RG ~ 


y 

z 

1 


(4.41) 


o, utilizando la cuarta columna de la ecuación (3.6) para i = 4, como: 


3 n _ 0 r p 1 r j~' 2 r p 

r 40RG — i 1 2 1 3 1 


o como 


) n _ Om 1 t 

M ORG ~ i 1 2 1 


—d 4 sa 3 
d 4 ca 3 


fM 

f 2 «h) 

A $* 3 ) 

1 


(4.42) 


(4.43) 


en donde 


"A" 


«3 

fi 

= 2 t 

—d 4 sa 3 

f 3 

3 

d 4 ca 3 

1 


1 


(4.44) 


Utilizando la ecuación (3.6) para 2 Ten la ecuación (4.44) se producen las siguientes ex¬ 
presiones para/): 

f\ = «3 C 3 + d 4 sa 3 s 3 + a 2 , 

f 2 = a 3 ca 2 s 3 — í/ 4 ío' 3 CO' 2 C 3 — d 4 sa 2 ca 3 — d 3 sa 2 , (4.45) 

f 3 = a 3 sa 2 s 3 — d 4 sa 3 sa 2 c 3 + d 4 ca 2 ca 3 + d 3 ca 2 . 

Utilizando la ecuación (3.6) para y \ T en la ecuación (4.43), obtenemos 


4 ORG 


c i8i ~ s i8 2 
s i8i + c 3 g 2 
8 3 

1 


(4.46) 


en donde 

81 = c lfl ~ s 2f2+ a l’ 

82 = s 2 ca l fl + c 2 ca l fl - sa \ h - d 2 soí l - ( 4 . 47 ) 

8 3 = s 2 sa 1/1 + c 2 saj 2 + ca x f -3 + d 2 ca x . 

Ahora escriba una expresión para la magnitud al cuadrado de 0 P 4ORG , que denotare¬ 
mos como r — x 2 + y 2 + z 2 , y que por la ecuación ( 4 . 46 ) puede verse como 

2 , 2 , 2. 

^ 4 ” 8 2 4 ~ 8 3 > 


(4.48) 
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por lo que, utilizando la ecuación (4.47) para las g¡, tenemos que 

r = fl+ / 2 2 + /3 + aZ i+ d 2 + 2d ih + 2fl i ( c 2/t - * 2 / 2 )- (4-49) 

Ahora escribiremos esta ecuación, junto con la del componente Z de (4.46), como un 
sistema de dos ecuaciones en la forma 

r = (k 3 c 2 + k 2 s 2 )2a 1 + k 3 , 

z = (k 3 s 2 — k 2 c 2 )sa 1 + k 4 , (4.50) 

en donde 

h = A, 

^ 2 = fi’ 

k 3 = / 2 + / 2 + / 2 + a \ + d 2 + 2d 2 f 3 , (4.51) 

k 4 = f 3 ca 3 + d 2 ca 3 . 

La ecuación (4.50) es útil, ya que se ha eliminado la dependencia de 6 1 y a que la de¬ 
pendencia de 0 2 toma una forma simple. 

Ahora consideremos la solución de la ecuación (4.50) para 9 V Distinguimos tres 
casos: 


1. Si a x = 0, tenemos que r — k 3 , en donde se conoce r. El lado derecho ( k 3 ) es una 
función de 0 3 solamente. Después de la sustitución en (4.35), puede resolverse 
una ecuación cuadrática en tan ~ para 0 y 

2. Si íoq = 0, tenemos que z — k 4 , en donde se conoce z,- De nuevo, después de sus¬ 
tituir mediante la ecuación (4.35), surge una ecuación cuadrática que puede resol¬ 
verse para 9 y 

3. De cualquier otra forma, elimine s 2 y c 2 de la ecuación (4.50) para obtener 


(r~k 3 ) 2 

4a ^ 


(z - k 4 ) 2 
1 

S A 0¿1 


~ k i +k r 


(4.52) 


Esta ecuación, después de sustituir (4.35) para 9 y produce una ecuación de grado 
4, la cual puede resolverse para 9 y 3 

Habiendo resuelto para 9 y podemos resolver la ecuación (4.50) para 9 2 y la (4.46) para 9 r 
Para completar nuestra solución, necesitamos resolver para 0 4 , 9- y 0 (y Estos ejes 
se intersecan, por lo que estos ángulos de articulación afectan a la orientación del últi¬ 
mo vínculo solamente. Podemos calcularlos a partir únicamente de la porción de rota¬ 
ción del destino especificado, ° 6 R. Después de obtener 0 V y 9 y podemos calcular 
4 R\ g4 _ 0 , por cuya notación indicamos la orientación de la trama de vínculo ¡4) relativa 
a la trama base cuando 9 4 — 0. La orientación deseada de ¡6} difiere de esta orientación 
sólo por la acción de las últimas tres articulaciones. Como el problema se especificó ba¬ 
jo el supuesto de que se conoce R. podemos calcular 


4 

6 


R I 


0 4=O 


°/r 1 


o 

® 4=0 6 


R. 


(4.53) 


3 Es útil tener en cuenta que f 2 + f 2 + f 2 = + d 2 + + 2d 4 d 3 ca 3 + 2a 2 a 3 c 3 + 2a 2 d 4 sa 3 s 3 . 
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Para muchos manipuladores, estos tres últimos ángulos pueden despejarse utili¬ 
zando exactamente la solución de ángulos de Euler Z-Y-Z dada en el capítulo 2, apli¬ 
cada a °/?| , 4=() . Para cualquier manipulador (en el que se intersequen los ejes 4, 5 y 6), 
los últimos tres ángulos de articulación pueden resolverse como un conjunto de ángulos 
de Euler definidos apropiadamente. Siempre hay dos soluciones para estas últimas tres 
articulaciones, por lo que el número total de soluciones para el manipulador será el do¬ 
ble del número encontrado para las primeras tres articulaciones. 

4.7 EJEMPLOS DE CINEMÁTICA INVERSA DE MANIPULADORES 

En esta sección trabajaremos con la cinemática inversa de dos robots industriales. Una 
solución para manipuladores se realizará de manera puramente algebraica; la segunda so¬ 
lución es en parte algebraica y en parte geométrica. Las siguientes soluciones no cons¬ 
tituyen un recetario para resolver la cinemática de manipuladores, pero muestran 
muchas de las manipulaciones comunes que comúnmente aparecen en la mayoría de las 
soluciones de cinemática. Tenga en cuenta que puede usar el método Pieper de solu¬ 
ción (cubierto en la sección anterior) para estos manipuladores, pero aquí optamos por 
llegar a la solución de una manera distinta para entender mejor los diversos métodos 
disponibles. 


El robot Unimation PUMA 560 


Como ejemplo de la técnica de solución algebraica aplicada a un manipulador con seis 
grados de libertad, resolveremos las ecuaciones cinemáticas del PUMA 560 que se de¬ 
sarrollaron en el capítulo 3. Esta solución está en el estilo de [5]. 

Deseamos resolver 


r u 

r 12 

r 13 

Px 

r 21 

r 22 

r 23 

Py 

r 31 

r 32 

r 33 

Pz 

0 

0 

0 

1 


= °7’(e 1 )ir(e 2 )2r(0 3 )3r(0 4 )5r(0 5 )5r(0 6 ) (4.54) 

para 6 ¡ cuando se da ° T en forma de valores numéricos. 

Un nuevo planteamiento de la ecuación (4.54) que pone la dependencia en Q l del 
lado izquierdo de la ecuación es 

[Jm)]" 1 l T = ^(02)11 (e 3 )lT(0 4 ) 4 5 T(e 5 ) 5 6 T(e 6 ). (4.55) 

Si invertimos 4 T, escribimos la ecuación (4.55) como 


c 4 s¡ 0 0 


r ll r \2 ''13 Px 

—.V | q 0 0 


r 2\ r 22 r 23 Py 

0 0 10 


r 31 r 32 '33 Pz 

0 0 0 1 


0 0 0 1 


(4.56) 


en donde ¿Ese da mediante la ecuación (3.13) que se desarrolló en el capítulo 3. Esta 
técnica simple de multiplicar cada lado de una ecuación de transformadas por una 
inversa se utiliza a menudo para aprovechar la separación de las variables en la búsque¬ 
da de una ecuación que pueda resolverse. 

Si igualamos los elementos (2,4) de ambos lados de la ecuación (4.56), tendremos que 


— í i Px + ¿'i P y = d 3 . 


(4.57) 
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Para resolver una ecuación de esta forma, hacemos las siguientes sustituciones trigono¬ 
métricas: 

P x = P COS0, 

p y — psencp, (4.58) 

en donde 

p = 7 ^ + 4 

0 = Atan2 (p y , p x ). (4.59) 

Si sustituimos la ecuación (4.58) en la (4.57), obtenemos 


c i s <p ~ s ^ c tp 


De la fórmula de diferencia de ángulos, 


sen(</> — ñ) = —. 

P 


Por lo tanto, 


d 2 

eos (0 -e 1 ) = ±J i —|, 


(4.60) 


(4.61) 


(4.62) 


y también 


c¡) — 0 l = Atan2 



(4.63) 


Por último, la solución para 9 ] puede escribirse como 

6 l = Atan2 (p y , p x ) - Atan2 (d 3 , ±Jp 2 x + p 2 - d 2 ^j . (4.64) 


Observe que hemos encontrado dos posibles soluciones para 6 V que corresponden al 
signo positivo o negativo en la ecuación (4.64). Ahora que tenemos 6 V se conoce el 
lado izquierdo de la ecuación (4.56). Si igualamos tanto los elementos (1,4) como (3,4) 
de los dos lados de (4.56), obtendremos 

C 1 Px + s lPy = a 3 c 23 - d 4 s 23 + a 2 c 2’ 

~Px ~ a 3 s 23 + d 4 c 23 + a 2 s 2‘ (4.65) 

Si elevamos al cuadrado las ecuaciones (4.65) y (4.57) y sumamos las ecuaciones resul¬ 
tantes, obtendremos 

CI 3 C 3 — d 4 s 3 = K , (4.66) 

en donde 


K = 



2 a 2 


(4.67) 
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Observe que se ha quitado la dependencia de 9 l de la ecuación (4.66). Esta ecuación tie¬ 
ne la misma forma que la ecuación (4.57), por lo que puede resolverse por el mismo 
tipo de sustitución trigonométrica para generar una solución para 9 3 : 

9 3 = Atan2(a 3 , d 4 ) — Atan2 (K, ±Ja| + d 3 — K 2 ). (4.68) 

El signo positivo o negativo en la ecuación (4.68) conduce a dos distintas soluciones pa¬ 
ra 6 y Si consideramos de nuevo la ecuación (4.54), ahora podemos reescribirla de mane¬ 
ra que todo el lado izquierdo sea una función solamente de variables conocidas y de 0 2 : 

[¡T(0 2 )]-'lT = 3 4 T(9 4 ) 4 5 T(9 5 ) 5 6 T(d 6 ), (4.69) 


O 


c l c 23 

J l c 23 

-s 23 

— a 2 c 3 


" r ll 

r 12 

r 13 

Px " 

C 1 v 23 

~ s l s 23 

c 23 

a 2 S3 


r 21 

r 22 

r 23 

Py 

-*1 

C 1 

0 

~ d 3 


r 31 

r 32 

r 33 

Pz 

0 

0 

0 

1 


0 

0 

0 

1 _ 


(4.70) 


en donde ¡? Tse da mediante la ecuación (3.11) desarrollada en el capítulo 3. Igua¬ 
lando los elementos (1,4) y (2,4) de los dos lados de la ecuación (4.70), obtenemos 


c l c 23 Px + s l c 23Py ~ s 23 Pz ~ a 2 c 3 = «3- 
~ c \ s 23Px - s \ s 23Py - c 23 P z + a 2 s 3 = d 4- ( 4 - 71 ) 


Estas ecuaciones pueden resolverse simultáneamente para s 23 y c 23 , lo que produce 


(-a 3 - a 2 c 3 )p z + ( c 3 p x + s 1 p y )(a 2 s 3 - d 4 ) 
PZ + (f'i P x + íiPy) 2 


(ct 2 s 3 - d 4 )p, - (q 3 + a 2 c 3 )(c 1 p x + s lPy ) 
P 2 . + (ct P x + s iP y ) 2 


(4.72) 


Los denominadores son iguales y positivos, por lo que resolvemos para la suma de 9 2 y 
9 3 como 


0 23 = Atan2[(—u 3 - a 2 c 3 )p, - (c 1 p x + s 1 p y )(d 4 - a 2 s 3 ), 

(a 2 s 3 - d 4 )p z - {a 3 + a 2 c 3 )(c 1 p x + s lPy )]. (4.73) 


La ecuación (4.73) calcula cuatro valores de 0 23 , de acuerdo con las cuatro posibles 
combinaciones de las soluciones para 9 X y 0 3 ; por lo que las cuatro posibles soluciones 
para 9 2 se pueden calcular así: 

^2 = ^23 — #3> (4.74) 

en donde la solución apropiada para 9 3 se obtiene al formar la diferencia. 

Ahora conocemos todo el lado izquierdo de la ecuación (4.70). Igualando los ele¬ 
mentos (1,3) y (3,3) de los dos lados de (4.70) obtenemos 

r 13 c l c 23 + r 23' s 'l c 23 ~ r 33 s 23 = _C 4 Í 5> 

-rt 3 Si + r 23 Ct = Í 4 Í 5 . (4.75) 

Siempre y cuando s 5 * 0, podremos resolver para 9 4 de la siguiente manera: 

9 4 — Atan2(—r 13 íj + r 23 c t , -r 13 c 1 c 23 - r 23 s x c 23 + r 33 i 23 ). 


(4.76) 
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Cuando 0 5 = 0, el manipulador se encuentra en una configuración singular en la que los 
ejes de articulación 4 y 6 se alinean y producen el mismo movimiento del último víncu¬ 
lo del robot. En este caso, todo lo que importa (y todo lo que puede resolverse) es la 
suma o diferencia de 0 4 y 0 (y Esta situación se detecta comprobando si ambos argumen¬ 
tos de la función Atan2 en la ecuación (4.76) están cerca de cero. De ser así, 0 4 se elige 
arbitrariamente 4 y, cuando se calcule 0 6 posteriormente, se calculará acorde con ello. 

Si vemos de nuevo la ecuación (4.56), podremos reescribirla ahora de manera que 
todo el lado izquierdo sea una función solamente de variables conocidas y 0 4 ; y la rees¬ 
cribiríamos, como 


[“mjr 1 = 4 5 T(d 5 )¡T(e 6 ), 

en donde [° 4 7’(04)] _1 se da mediante 

c l c 23 c 4 + S \ S 4 *1 c 23 c 4 - c l s 4 _í 23 c 4 ~ fl 2 c 3 c 4 + ^3 S 4 ~ a 3 c 4 
- c l c 23 s 4 + ‘ s l c 4 -■ s l c 23‘ ? 4 _ c l c 4 s 23 s 4 a 2 C 3 s 4 + d 3 c 4 + a 3 S 4 
-c l s 23 _ ' S V S ’23 c 23 a 2 s 3 ~ d 4 

0 0 0 1 


(4.77) 


(4.78) 


y 5 T mediante la ecuación (3.10) desarrollada en el capítulo 3. Igualando los elementos 
(1,3) y (3,3) de ambos lados de la ecuación (4.77), obtenemos 

r 13( c l c 23 c 4 + W + ^23( s l c 23 c 4 “ C D4) “ r 33^ s 23 c 4) = ~ s $’ 

r 13(“ c l í 23) + r 23( —s l s 23) + r 33(~ c 23) = c 5- (4.79) 


Por lo tanto, podemos resolver para 0 5 de la siguiente manera: 

0 5 = Atan2(í 5 , c 5 ), (4.80) 

en donde s 5 y c 5 se obtienen mediante la ecuación (4.79). 

Aplicando el mismo método una vez más, calculamos (9 T) 1 y escribimos la ecua¬ 
ción (4.54) de la siguiente forma: 


(° Ty 1 ° 6 T = ¡T(0 6 ). (4.81) 

Igualando los elementos (3,1) y (1,1) de ambos lados de la ecuación (4.77), como lo hi¬ 
cimos antes, obtenemos 


0 6 = Atan2(s 6 ,c 6 ), 


(4.82) 


en donde 

s 6 = -'n( c l c 23 í 4 - s l c 4) - r 2\( s l c 23 s 4 + c l c 4) + r 3l( s 23 s 4). 

c 6 = '•11IXC1C23C4 + 5 i 5 4 )c 5 - CJÍ23Í5] + r 2 i[(í 1 C 23 C4 - CjSqjCj - Í,V 23 


~ r 3l( í 23 c 4 c 5 + c 23 s 5)- 


Debido a los signos positivo y negativo que aparecen en las ecuaciones (4.64) y (4.68), 
éstas cuatro soluciones. Además, hay cuatro soluciones adicionales que se obtienen 


4 Por lo general se elige de manera que sea igual al valor actual de la articulación 4. 
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“volteando” la muñeca del manipulador. Para cada una de las cuatro soluciones calcu¬ 
ladas antes, obtenemos la solución inversa mediante 

0' =0 4 +18O°, 

9' 5 = -0 5 , (4.83) 

0 ' = e 6 + 180°. 

Una vez que se han calculado las ocho soluciones, habrá que descartar algunas de ellas 
(o incluso todas) debido a violaciones en los límites de las articulaciones. De cualquier 
solución válida restante, generalmente se selecciona la más cercana a la configuración 
actual del manipulador. 


El Yasukawa Motoman L-3 

Como segundo ejemplo resolveremos las ecuaciones cinemáticas del Yasukawa Moto¬ 
man L-3 que se desarrollaron en el capítulo 3. Esta solución será en parte algebraica y en 
parte geométrica. El Motoman L-3 tiene tres características que hacen que el problema 
de cinemática inversa sea bastante distinto al de PUMA. En primer lugar el manipulador 
sólo tiene cinco articulaciones, por lo que no puede posicionar y orientar su efector final 
para llegar a tramas que sean destinos generales. En segundo lugar, el tipo de articulacio¬ 
nes de cuatro barras y el esquema de transmisión de cadena hacen que un actuador mue¬ 
va dos o más articulaciones. En tercer lugar, los límites de posición de cada actuador no 
son constantes, sino que dependen de las posiciones de los otros actuadores, por lo que 
no es fácil averiguar si un conjunto calculado de valores del actuador está en el rango. 

Si consideramos la naturaleza del subespacio del manipulador Motoman (lo mis¬ 
mo se aplica a muchos manipuladores con cinco grados de libertad), rápidamente nos 
daremos cuenta que este subespacio puede describirse proporcionando una restricción en 
la orientación alcanzable: la dirección en la que apunta la herramienta, es decir, el eje 
Z T , debe estar en el “plano del brazo”. Este plano es el plano vertical que contiene el 
eje de la articulación 1 y el punto en el que los ejes 4 y 5 se intersecan. La orientación 
más cercana a una orientación general es la que se obtiene girando la dirección en la 
que apunta la herramienta de manera que se encuentre en el plano, utilizando una mí¬ 
nima cantidad de rotación. Sin desarrollar una expresión explícita para este subespacio 
construiremos un método para proyectar una trama de destino general sobre él. Obser¬ 
ve que toda esta discusión es para el caso en el que la trama de muñeca y la trama he¬ 
rramienta difieran solamente por una traslación sobre el eje Z w 

En la figura 4.9, indicamos el plano del brazo mediante su normal M, y la direc¬ 
ción en la que se desea que apunte la herramienta mediante Z r Esta dirección debe gi¬ 
rarse por un ángulo 0 sobre un vector Apara poder hacer que la nueva dirección a la 
que apunte la herramienta, Z’ T , se encuentre en el plano. Está claro que el vector Áque 
minimiza 9 se encuentra en el plano y es ortogonal a Z T y Z' r 
Para cualquier trama de destino dada, M se define como 


M 


I 


Pl + P 2 y 



(4.84), 


en donde p x y p v son las coordenadas A y Y de la posición deseada para la herramien¬ 
ta. Entonces Ase da mediante 


A= M x Z T 


(4.85) 
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FIGURA 4.9: Cómo girar una trama de destino en el subespacio del Motoman. 


El nuevo Z' T sería 


Z' t = K x M. 

La cantidad de rotación 6 se da mediante 

cosd = Z T ■ Z' , 
send = {Z r x Z.' ) ■ K. 


(4.86) 


(4.87) 


Usando la fórmula de rotación de Rodrigues (vea el ejercicio 2.20) tenemos que 

Y' t = c6Y t + s6(K x Y t ) + (1 - c9)(K ■ Y T )K. (4.88) 

Por último, calculamos la columna desconocida restante de la nueva matriz de rotación 
de la herramienta de la siguiente manera: 

X' T = Y' t x Z' r (4.89) 

Las ecuaciones (4.84) a (4.89) describen un método para proyectar una orientación de 
destino general dada en el subespacio del robot Motoman. 

Suponiendo que la trama de muñeca ¡^T dada se encuentre en el subespacio del 
manipulador, resolveremos las ecuaciones cinemáticas como se muestra a continua¬ 
ción. Al derivar las ecuaciones cinemáticas para el Motoman L-3 formamos el produc¬ 
to de transformaciones de vínculos: 


Uj 1 U r J~’ J . r T' Zy J rp 

5 - 1 2 3 4 5 ■ 

Si dejamos que 

r ll r 12 r 13 Px~ 
r 21 r 22 r 23 Py 

r 31 r 32 r 33 Pz 

0 0 0 1 _ 

y multiplicamos previamente ambos lados por ° T~ l , tenemos 

0 ’-p — 1 0 rp _ 1 nr 2 r p 3 r j i 4 J- 

1 5 _ 2 3 4 5 ’ 



(4.90) 


(4.91) 


(4.92) 
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en donde el lado izquierdo sería 

c l r U+ s l r 21 c l r 12 + s l r 22 c l r 13 + s l r 23 c lPx + s lPy 


~ r 31 


~ r 32 


~ r 33 


~Pz 


- s l r l\+ c \ r 2\ ~ s l r l2 + c l r 22 ~ s l r 13 + c l r 23 ~ s lP x + c lPy 


0 


y el lado derecho sería 


0 


0 


1 


(4.93) 


^ ^ S' 

* * 


234 

c 234 


s 5 c 5 0 0 

0 0 0 1 


(4.94) 


en la ecuación anterior no se mostraron varios elementos. Si igualamos los elementos 
(3,4) obtendremos 


~ s lPx + C 1 Py = °’ 

lo cual nos produce 5 

0\ = Atan2 (p y , p x ). 

Igualando los elementos (3,1) y (3,2) obtendremos 

S s = ~ s i r n + c i r 2 i’ 

c 5 = ~ s l r 12 + c \ r 22 ’ 


(4.95) 

(4.96) 

(4.97) 


de lo cual podemos calcular d s de la siguiente manera: 

9 5 = Atan2(r 21 c 1 - r n s x , r 22 c x - r nSl ). (4.98) 

Igualando los elementos (2,3) y (1,3) obtendremos 

c 234 = r 33’ 


^234 — c l''l3 + s l r 23- 


(4.99) 


lo cual nos conduce a 


^234 — Atan2(r 13 c 1 + r 73 s 1 , r 33 ). (4.100) 

Para resolver los ángulos individuales 0 2 , 0 3 , y 0 4 , usaremos un método geométrico. La 
figura 4.10 muestra el plano del brazo con el punto A en el eje de articulación 2, el pun¬ 
to B en el eje de articulación 3 y el punto C en el eje de articulación 4. 

De la ley de los cosenos aplicada al triángulo ABC , tenemos que 


COS0 3 = 


p 2 + p 2 + p 2 — l~ — /? 

r x y z 2 3 

2Z 2 / 3 


Después tenemos que 6 


0 3 — Atan2 ( J1 — eos 2 0 3 , cosí 


(4.101) 


(4.102) 


5 Para este manipulador, una segunda solución violaría los límites de las articulaciones, por lo que no se 
calcula. 

6 Para este manipulador, una segunda solución violaría los límites de las articulaciones, por lo que no se 
calcula. 
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FIGURA 4.10: El plano del manipulador Motoman. 


De la figura 4.10 podemos ver que 0 2 = —cp — p, o 

0 2 = — Atan2 (^p„, J + p 2 ^j — Atan2 (/ 3 sen0 3 , l 2 + Z 3 cos0 3 ). (4.103) 

Finalmente, tenemos que 


$4 — ^234 — $2 ~ ^ 3 ' 


(4.104) 


Después de resolver para los ángulos de articulación, debemos realizar el siguiente cálcu¬ 
lo para obtener los valores de los actuadores. Si hacemos referencia a la sección 3.7 re¬ 
solveremos la ecuación (3.16) para los A¡: 


A l — — (d l - X{), 


A 2 = ( J-2a 2 p 2 eos ( 0 2 - Í2 2 - tan 1 ( — ) + 270° ) + + P 2 - A 2 


y2 


A, = 


—2a 3 p 3 eos ( 0 2 + 0 2 — tan 


-i (ti 
Y 3 


+ 90° ) + «2 + £2 - X 3 


A 4 — —(180° + 7.4 — 0 2 — 0 3 — 64 ), 


^5 — T&5 - %)• 


1(4.105) 


Los actuadores tienen rangos limitados de movimiento, por lo que debemos compro¬ 
bar que la solución que hayamos calculado esté dentro del rango. Esta comprobación 
“dentro del rango” se complica por el hecho de que el arreglo mecánico hace que los 
actuadores interactúen entre sí y afecten sus rangos de movimiento permitido. Para el 
robot Motoman, los actuadores 2 y 3 interactúan de una forma tal que debe obedecer 
siempre la siguiente relación: 


A 2 - 10, 000 > A 3 > A 2 + 3000. 


(4.106) 
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Esto es, los límites del actuador 3 son una función de la posición del actuador 2. De ma¬ 
nera similar, 


32,000 - A 4 < A 5 < 55,000. (4.107) 

Ahora, una revolución de la articulación 5 corresponde a 25,600 conteos del actuador 
por lo que, cuando A 4 > 2600, hay dos posibles soluciones para A s . Ésta es la única si¬ 
tuación en la que el Yasukawa Motoman L-3 tiene más de una solución. 

4.8 LAS TRAMAS ESTÁNDAR 

La habilidad de despejar los ángulos de articulación es realmente el elemento central 
en muchos sistemas de control de robots. De nuevo, considere el paradigma indicado en 
la figura 4.11 que muestra las tramas estándar. 

La manera en que se utilizan estas tramas en un sistema de robot general es la 
siguiente: 

1. El usuario le indica al sistema en dónde se va a ubicar la trama estación. Ésta po¬ 
dría encontrarse en la esquina de una superficie de trabajo, como en la figura 
4.12, o incluso sujetarse a una banda transportadora móvil. La trama estación ¡S) 
se define en forma relativa a la trama base ¡5j. 

2. El usuario especifica la descripción de la herramienta que está utilizando el robot 
y proporciona la especificación de la trama ¡L}. Cada herramienta que recoge el 
robot podría tener asociada una trama { T] distinta. Observe que la misma herra¬ 
mienta sujeta de distintas formas requiere distintas definiciones de la trama {Lj. 
¡Tj se especifica de manera relativa a ¡W¡; esto es, ^T. 

3. El usuario especifica el punto de destino para el movimiento de un robot, propor¬ 
cionando la descripción de la trama de destino ¡G) relativa a la trama estación. A 
menudo las definiciones de ¡7] y {.S'j permanecen fijas para varios movimientos 
del robot. En este caso, una vez definidos, el usuario simplemente proporciona 
una serie de especificaciones de ¡Gj. 



FIGURA 4.11: Ubicación de las tramas "estándar". 
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En muchos sistemas la definición de la trama herramienta T) es constante (por 
ejemplo, se define con su origen al centro de la punta de los dedos). Además, la 
trama estación podría ser fija o el usuario podría enseñarla fácilmente al mismo 
robot. En dichos sistemas el usuario no necesita conocer las cinco tramas están¬ 
dar; simplemente piensa en términos de mover la herramienta a posiciones (des¬ 
tinos) respecto al área de trabajo especificada por la trama estación. 

4. El sistema de robot calcula una serie de ángulos de articulación para mover las 
articulaciones de manera que la trama herramienta se mueva desde su posición 
inicial en forma uniforme hasta que ¡7] = ¡Gj al final del movimiento. 

4.9 CÓMO RESOLVER UN MANIPULADOR 

La función RESOLVER (SOLVE) implementa transformaciones cartesianas y llama 
a la función cinemática inversa, Por lo tanto, la cinemática inversa se generaliza de 
manera que puedan utilizarse definiciones arbitrarias para la trama herramienta y la 
trama estación con nuestra cinemática inversa, la cual despeja la trama de muñeca en 
términos de la trama base. 

Dada la especificación de la trama de destino £r, RESOLVER utiliza las defini¬ 
ciones de herramienta y estación para calcular la ubicación de ¡Wj relativa a ¡5j, S,T: 


B y _ B y S y W y — 1 

WSTT 


(4.108) 


Entonces, la cinemática inversa toma como entrada y calcula los valores de 6 1 a Q 
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4.10 REPETITIVIDAD Y PRECISIÓN 

En la actualidad muchos robots industriales se mueven hacia puntos de destino que les 
han sido enseñados. Un punto enseñado es uno al que el manipulador se mueve física¬ 
mente, después se leen los sensores de posición de articulación y se almacenan los án¬ 
gulos de articulación. Cuando se ordena al robot que regrese a ese punto en el espacio, 
cada articulación se mueve al valor almacenado. En manipuladores simples del tipo 
“enseñar y reproducir” como éstos nunca surge el problema de cinemática inversa, ya 
que los puntos de destino nunca se especifican en coordenadas cartesianas. Cuando un 
fabricante especifica con qué precisión puede un manipulador regresar a un punto en¬ 
señado, está especificando la repetitividad del manipulador. 

Siempre que se especifica una posición de destino y una orientación en términos 
cartesianos, debe calcularse la cinemática inversa del dispositivo para poder despejar 
los ángulos de articulación requeridos. Los sistemas que permiten describir destinos en 
términos cartesianos son capaces de mover el manipulador a puntos que nunca fueron 
enseñados; puntos en el espacio de trabajo a los cuales tal vez nunca haya ido antes. A 
esos puntos los llamaremos puntos calculados. Dicha capacidad es necesaria para mu¬ 
chas tareas de manipulación. Por ejemplo, si se utiliza un sistema de visión computacio- 
nal para localizar una pieza que el robot debe sujetar, éste debe poder moverse a las 
coordenadas cartesianas proporcionadas por el sensor de visión. La precisión con la 
que se puede llegar a un punto calculado se conoce como precisión del manipulador. 

La precisión de un manipulador está confinada por la repetitividad. Evidentemen¬ 
te la precisión se ve afectada por la precisión de los parámetros que aparecen en las ecua¬ 
ciones cinemáticas del robot. Si no se conocen bien los parámetros Denavit-Hartenberg 
las ecuaciones cinemáticas inversas calcularán valores de ángulos de articulación erró¬ 
neos. Por ende, aunque la repetitividad de la mayoría de los manipuladores industriales 
es bastante buena, la precisión es generalmente mucho peor y varía considerablemente 
de un manipulador a otro. Pueden idearse técnicas de calibración que permitan mejo¬ 
rar la precisión de un manipulador a través de la estimación de esos parámetros cine¬ 
máticos específicos del manipulador [10]. 

4.11 CONSIDERACIONES COMPUTACIONALES 

En muchos esquemas de control de trayectoria, los cuales consideraremos en el capítulo 7, 
es necesario calcular la cinemática inversa de un manipulador a frecuencias considera¬ 
blemente altas; por ejemplo de 30Hz o más. Por lo tanto, la eficiencia computacional es 
una cuestión importante a considerar. Estos requerimientos de velocidad descartan el uso 
de técnicas de solución numérica que son iterativas por naturaleza y que, por esta razón, 
no hemos considerado. 

La mayor parte de los comentarios generales de la sección 3.10, dirigidos a la ci¬ 
nemática directa, también se aplican para el problema de la cinemática inversa. Para 
este caso se utiliza comúnmente una rutina Atan2 de búsqueda en tabla para obtener 
velocidades mayores. 

También es importante la estructura de la computación de múltiples soluciones. 
Generalmente es más eficiente evaluarlas en paralelo, en vez de hacerlo en forma se¬ 
rial. Desde luego que, en ciertas aplicaciones en donde no se requieren todas las solu¬ 
ciones, ahorra mucho tiempo. 

Cuando se utiliza un método geométrico para desarrollar una solución cinemáti¬ 
ca inversa, en ocasiones es posible calcular varias soluciones mediante operaciones sim¬ 
ples sobre los diversos ángulos que se despejaron al obtener la primera solución. Esto 
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es, la primera solución es moderadamente costosa en términos computacionales, pero 
las demás soluciones se encuentran con mucha rapidez al sumar y diferenciar ángulos, 
restar n, etcétera. 
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EJERCICIOS 

4.1 [15] Bosqueje el espacio de trabajo de la punta de los dedos del manipulador de tres 
vínculos del capítulo 3, ejercicio 3.3 para el caso f = 15.0, Z 2 = 10.0 y l 3 — 3.0. 

4.2 [26] Derive la cinemática inversa del manipulador de tres vínculos del capítulo 3, ejer¬ 
cicio 3.3. 

4.3 [12] Bosqueje el espacio de trabajo de la punta de los dedos del manipulador 3-DOF 
del capítulo 3, ejemplo 3.4. 
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4.4 [24] Derive la cinemática inversa del manipulador 3-DOF del capítulo 3, ejemplo 3.4. 

4.5 [38] Escriba una subrutina en Pascal (o C) que calcule todas las posibles soluciones 
para el manipulador PUMA 560 que se encuentren dentro de los siguientes límites de 
articulación: 


-170.0 <9 1 < 170.0, 
-225.0 < 0 2 < 45.0, 
-250.0 < d 3 < 75.0, 
-135.0 <9 4 < 135.0, 

-íoo.o < e 5 < íoo.o, 

-180.0 <0 6 < 180.0. 


Use las ecuaciones derivadas en la sección 4.7 con estos valores numéricos (en pulgadas): 


a 2 = 17.0, 
a 3 = 0.8, 
d 3 =4.9, 
d 4 = 17.0. 


4.6 [15] Describa un algoritmo simple para seleccionar la solución más cercana de un con¬ 
junto de posibles soluciones. 

4.7 [10] Haga una lista de factores que podrían afectar la repetitividad de un manipulador. 
Haga una segunda lista de factores adicionales que afectan la precisión de un mani¬ 
pulador. 

4.8 [12] Dada una posición y orientación deseadas de la mano de un manipulador planar 
de articulaciones giratorias y tres vínculos, hay dos posibles soluciones. Si agregamos 
una articulación giratoria más (de manera tal que el brazo siga siendo planar), ¿cuán¬ 
tas soluciones habrá? 

4.9 [26] La figura 4.13 muestra un brazo planar de dos vínculos con articulaciones gira¬ 
torias. Para este brazo el segundo vínculo es la mitad de largo que el primero; esto es, 
/j = 2 1 2 . Los límites de rango de las articulaciones en grados son 



/ 


FIGURA 4.13: Manipulador planar de dos vínculos. 
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o < < 180, 

-90 <e 2 < 180. 

Bosqueje el espacio de trabajo alcanzable aproximado (un área) de la punta del 
vínculo 2. 

4.10 [23] Proporcione una expresión para el subespacio del manipulador del capítulo 3, 
ejemplo 3.4. 

4.11 [24] Una tabla de posicionamiento 2-DOF se utiliza para orientar piezas para solda¬ 
dura de arco. La cinemática directa que ubica la cubierta de la mesa (vínculo 2) con 
respecto a la base (vínculo 0) es 

c i c 2 ~ c i s 2 J i h s i + h 

s 2 c 2 0 0 

~ s l c 2 s l s 2 c í ^ 2 C 1 + ^1 

0 0 0 1 

Dada cualquier dirección unitaria fija en la trama de la cubierta (vínculo 2) represen¬ 
tada por 2 V, proporcione la solución de cinemática inversa para 6 V d 2 de manera tal 
que este vector esté alineado con °Z(es decir, hacia arriba). ¿Hay múltiples solucio¬ 
nes? ¿Existe una sola condición para la que no pueda obtenerse una solución única? 

4.12 [22] En la figura 4.14 se ilustran dos mecanismos 3 R. En ambos casos los tres ejes se 
intersecan en un punto (y, sobre todas las configuraciones, este punto permanece fijo 
en el espacio). El mecanismo de la figura 4.14(a) tiene un ángulo de torsión de víncu¬ 
lo (a¡) con magnitud de 90 grados. El mecanismo de la figura 4.14(b) tiene una torsión 
de magnitud 0 y otra de 180 — 0 en magnitud. 

Se puede ver que el mecanismo de la figura 4.14(a) se encuentra en correspondencia 
con los ángulos de Euler Z-Y-Z, y por lo tanto sabemos que basta con orientar el víncu¬ 
lo 3 (con la flecha en la figura) arbitrariamente con respecto al vínculo 0 fijo. Como 0 
no es igual a 90 grados, resulta que el otro mecanismo no puede orientar el vínculo 3 
de manera arbitraria. 




(a) (b) 


FIGURA 4.14: Dos mecanismos 3 R (ejercicio 4.12). 
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FIGURA 4.15: Un manipulador 4 R mostrado en la posición © = [0, 90°, —90°, 0]T (ejer¬ 
cicio 4.16). 

Describa el conjunto de orientaciones que son inalcanzables con el segundo mecanis¬ 
mo. Observe que asumimos que todas las articulaciones pueden girar 360 grados (es 
decir, sin límites) y suponemos que los vínculos pueden pasar uno a través del otro si 
es necesario (es decir, el espacio de trabajo no está limitado por autocolisiones). 

4.13 [13] Mencione dos razones para las que se prefieren soluciones cinemáticas analíticas 
de forma cerrada en vez de soluciones iterativas. 

4.14 [14] Existen robots 6-DOF para los que la cinemática NO puede resolverse en forma 
cerrada. ¿Existe algún robot 3-DOF para el que la cinemática (de posición) NO pue¬ 
da resolverse en forma cerrada? 

4.15 [38] Escriba una subrutina que resuelva ecuaciones cuadráticas en forma cerrada. 
(Vea [8, 9]). 

4.16 [25] Un manipulador 4 R se muestra esquemáticamente en la figura 4.15. Los paráme¬ 
tros de vínculo distintos de cero son a 1 = 1, a., = 45°, d 3 = *J7.. y a 3 = y el meca¬ 
nismo se ilustra en la configuración que corresponde a 0 = [0, 90°, —90°, 0] 7 . Cada 
articulación tiene ±180° como límites. Encuentre todos los valores de 0 2 tales que 

° 7 Wg = [ 1 - 1 > 1 .5,1.707] 7 '. 

4.17 [25] La figura 4.16 muestra esquemáticamente un manipulador 4R. Los parámetros de 
vínculo distintos de cero son a. l = —90°, d 1 = 1, a 2 = 45°, d 3 = 1 y a 3 = 1, y el meca¬ 
nismo se ilustra en la configuración que corresponde a 0 = [0, 0, 90°, 0] r . Cada articu¬ 
lación tiene ±180° como límites. Encuentre todos los valores de & 3 tales que 

07 Wg = [°-°’ L0,1.414] r . 

4.18 [15] Considere el manipulador RRP que se muestra en la figura 3.37. ¿Cuántas solu¬ 
ciones (posición) poseen las ecuaciones cinemáticas? 

4.19 [15] Considere el manipulador RRR que se muestra en la figura 3.38. ¿Cuántas solu¬ 
ciones (posición) poseen las ecuaciones cinemáticas? 

4.20 [15] Considere el manipulador RPP que se muestra en la figura 3.39. ¿Cuántas solu¬ 
ciones (posición) poseen las ecuaciones cinemáticas? 
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FIGURA 4.16: Un manipulador 4 R en la posición © = [0, 0, 90°, 0] r (ejercicio 4.17). 


4.21 [15] Considere el manipulador PRR que se muestra en la figura 3.40. ¿Cuántas solu¬ 
ciones (posición) poseen las ecuaciones cinemáticas? 

4.22 [15] Considere el manipulador PPP que se muestra en la figura 3.41. ¿Cuántas solu¬ 
ciones (posición) poseen las ecuaciones cinemáticas? 

4.23 [38] Las siguientes ecuaciones cinemáticas surgen en cierto problema: 

sen£ = a sen# + b, 
sen <p = ecos 6 + d, 

f = ? + </>■ 

Dadas a,b,c,dy \¡r muestre que, en el caso general, existen cuatro soluciones para 8 . Pro¬ 
porcione una condición especial bajo la cual haya solamente dos soluciones para 9. 

4.24 [20] Dada la descripción de la trama de vínculo [i] en términos de la trama de víncu¬ 
lo {/ — 1], encuentre los cuatro parámetros de Denavit-Hartenberg como funciones de 
los elementos de ‘~ l T. 

EJERCICIO DE PROGRAMACIÓN (PARTE 4) 

1. Escriba una subrutina para calcular la cinemática inversa para el manipulador de tres 
vínculos de la sección 4.4. La rutina debe pasar argumentos en la siguiente forma: 

Procedure CININV(VAR wrelb: trama; VAR actual, cerca, lejos: vec3; 
VAR sol: boolean); 

en donde “wrelb” (entrada) es la trama de muñeca especificada en forma relativa a la 
trama base ; “actual” (entrada) es la posición actual del robot (dada como un vector 
de ángulos de articulación); “cerca” es la solución más cercana; “lejos” es la segunda 
solución, y “sol” es una bandera que indica si se encontraron soluciones o no. (sol = 
FALSE si no se encontraron soluciones). Las longitudes de vínculo (en metros) son: 


\ = l 2 = 0.5. 
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Los rangos de movimiento de las articulaciones son: 

-170° < 9¡ < 170°. 

Pruebe su rutina llamándola en conjunto con CIN para demostrar que son ciertamen¬ 
te inversas una de la otra. 

2. Hay una herramienta unida al vínculo 3 del manipulador. Esta herramienta está des¬ 
crita por ™ T, la trama herramienta relativa a la trama de la muñeca. Además, un usua¬ 
rio ha descrito su área de trabajo, la trama estación relativa a la base del robot, como 
J* I . Escriba la subrutina 

Procedure RESOLVER(VAR trels: trama; VAR actual, cerca, 
lejos: vec3; VAR sol: boolean); 

en donde “trels” es la trama ¡7] especificada en forma relativa a la trama {5j. Los de¬ 
más parámetros son exactamente iguales a los de la subrutina cininv. Las definiciones de 
{L} y {5j deben ser variables o constantes definidas en forma global. RESOLVER de¬ 
be utilizar llamadas a TMULT, TINVERT y CININV. 

3. Escriba la secuencia principal del programa para que acepte una trama destino espe¬ 
cificada en términos de x, y y cp. Esta especificación de destino es ¡7) relativa a {Sj, que 
es la manera en que el usuario desea especificar destinos. 

El robot utiliza la misma herramienta en la misma área de trabajo que en el ejercicio 
de programación (parte 2), por lo que {7”} y {S'j se definen como 

= [x y 9] = [0.10.2 30.0], 

B S T = [x y 9] = [-0.1 0.3 0.0], 

Calcule los ángulos de articulación para cada una de las siguientes tramas de destino: 

[x 3 y± <t>i] = [0.0 0.0 — 90.0], 

[x 2 y 2 4>2 1 = [0-6 — 0.3 45.0], 

[x 3 y 3 <p 3 ] = [-0.4 0.3 120.0], 

[x 4 y 4 <t> 4 \ = [0.8 1.4 30.0], 

Suponga que el robot empezará con todos los ángulos iguales a 0.0 y se moverá a estos 
tres destinos en secuencia. El programa deberá encontrar la solución más cercana res¬ 
pecto al punto de destino anterior. Usted deberá llamar consecutivamente a RESOLVER y 
DONDE para asegurarse que sean verdaderamente funciones inversas. 

EJERCICIO MATLAB 4 

Este ejercicio se enfoca en la solución de cinemática de planteamiento inverso para el robot 
planar 3-DOF, 3R. (Vea las figuras 3.6 y 3.7; los parámetros de DH se proporcionan en la figu¬ 
ra 3.8). Se proporcionan los siguientes parámetros de longitud fija: L x = 4, = 3 y L 3 = 2(m). 

a) Derive en forma analítica y a mano, la solución de planteamiento inverso para este ro¬ 
bot. Dada T, calcule todas las múltiples soluciones posibles para \9 ¡ 9 2 9 3 }. (Se pre¬ 
sentan tres métodos en el texto; elija uno de ellos). Sugerencia: para simplificar las 
ecuaciones, primero calcule “7 a partir de 7' y L y 

b) Desarrolle un programa de MATLAB para resolver por completo este problema 
de cinemática de planteamiento inverso para el robot 3R planar (es decir, proporcio¬ 
ne todas las múltiples soluciones). Pruebe su programa utilizando los siguientes casos 
de entrada: 
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i) ° h t 
ü) ° h t 

üi) V 

iv) ° h T 


-1 0 0 9- 
0 10 0 
0010 ' 

.0 0 0 1 . 

- 0.5 -0.866 0 7.5373- 

0.866 0.6 0 3.9266 

0 0 10 

0 0 0 1 

-0 10-3- 
-10 0 2 

0 0 1 o • 

. 0 0 0 1 _ 

-0.866 0.5 0 -3.1245- 
-0.5 0.866 0 9.1674 
0 0 10 
.0 0 0 1 


Para todos los casos emplee una comprobación circular para validar sus resultados: in¬ 
troduzca cada conjunto de ángulos de articulación (para cada una de las múltiples so¬ 
luciones) de vuelta en el programa MATLAB de cinemática de planteamiento directo 
para demostrar que obtiene la matriz ^ T original, 
c) Compruebe todos los resultados por medio de la Caja de Herramientas de Robótica 
MATLAB de Corke. Pruebe la función ikine(). 
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5.1 INTRODUCCIÓN 

5.2 NOTACIÓN PARA LA POSICIÓN Y ORIENTACIÓN VARIANTES EN EL TIEMPO 

5.3 VELOCIDAD LINEAL Y ROTACIONAL DE CUERPOS RÍGIDOS 

5.4 MÁS SOBRE VELOCIDAD ANGULAR 

5.5 MOVIMIENTO DE LOS VÍNCULOS DE UN ROBOT 

5.6 "PROPAGACIÓN" DE VELOCIDAD DE VÍNCULO A VÍNCULO 

5.7 JACOBIANOS 

5.8 SINGULARIDADES 
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5.10 JACOBIANOS EN EL DOMINIO DE LA FUERZA 

5.11 TRANSFORMACIÓN CARTESIANA DE VELOCIDADES Y FUERZAS ESTÁTICAS 


5.1 INTRODUCCIÓN 

En este capítulo expandiremos nuestra consideración de los manipuladores de robots 
más allá de los problemas de posicionamiento estático. Examinaremos las nociones de 
velocidad lineal y angular de un cuerpo rígido y utilizaremos estos conceptos para ana¬ 
lizar el movimiento de un manipulador. También consideraremos las fuerzas que actúan 
sobre un cuerpo rígido y después utilizaremos estas ideas para estudiar la aplicación de 
fuerzas estáticas con los manipuladores. 

Resulta ser que el estudio de ambas velocidades y fuerzas estáticas nos lleva a una 
matriz llamada el jacobiano 1 del manipulador, que presentaremos en este capítulo. 

El campo de la cinemática de mecanismos no se trata aquí con gran profundidad. 
En su mayor parte la presentación se restringe sólo a aquellas ideas que son fundamen¬ 
tales para el problema específico de la robótica. Si desea profundizar en este tema 
consulte algún texto sobre mecánica [1 a 3]. 

5.2 NOTACIÓN PARA LA POSICIÓN Y ORIENTACIÓN VARIANTES EN EL TIEMPO 

Antes de investigar la descripción del movimiento de un cuerpo rígido, hablaremos 
brevemente sobre ciertas cuestiones básicas: la diferenciación de vectores, la represen¬ 
tación de la velocidad angular y la notación. 


1 Los matemáticos la llaman a veces “matriz jacobiana”, pero los robóticos generalmente la abrevian sim¬ 
plemente como “jacobiano”. 
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Diferenciación de los vectores de posición 

Como base para nuestra consideración de velocidades (y, en el capítulo 6, de acelera¬ 
ciones) necesitaremos la siguiente notación para la derivada de un vector: 


B 


V r 


d 

dt 


b q = 


lím 

A /->0 


B Q(t + At) - B Q(t) 
A t 


(5.1) 


La velocidad de un vector de posición puede definirse como la velocidad lineal del pun¬ 
to en el espacio representado por el vector de posición. De la ecuación (5.1), podemos 
ver que estamos calculando la derivada de Q relativa a la trama ¡5). Por ejemplo, si Q 
no está cambiando en el tiempo respecto a ¡5j, entonces la velocidad calculada es ce¬ 
ro; aun si hay alguna otra trama en la que Q esté variando. Por lo tanto, es importante 
indicar la trama en la que se diferencia el vector. 

Al igual que con cualquier vector, un vector de velocidad puede describirse en 
términos de cualquier trama, y esta trama de referencia se indica con un superíndice a 
la izquierda. Por ende, el vector de velocidad calculado por la ecuación (5.1) expresa¬ 
do en términos de la trama ¡A) se escribiría así: 

\b Vq)= A _Ib q (5 . 2) 

Entonces vemos que, en el caso general, un vector de velocidad está asociado con un 
punto en el espacio, pero los valores numéricos que describen la velocidad de ese pun¬ 
to dependen de dos tramas: una respecto a la que se realizó la diferenciación y otra res¬ 
pecto a la que se expresó el vector de velocidad resultante. 

En la ecuación (5.1), la velocidad calculada se escribe en términos de la trama de 
diferenciación, por lo que el resultado podría indicarse con un superíndice B a la iz¬ 
quierda pero, por simplicidad, cuando ambos superíndices son iguales, no necesitamos 
indicar el exterior; es decir, podemos escribir: 

B Í B V q ) = B V q . (5.3) 


Por último, podemos eliminar el superíndice externo a la izquierda, incluyendo explí¬ 
citamente la matriz de rotación que realiza el cambio en la trama de referencia (vea la 
sección 2.10); esto es, escribimos lo siguiente: 

a ( b V q ) = a b R b V q . (5.4) 

En general escribiremos expresiones de la forma del lado derecho de la ecuación (5.4), 
de manera que los símbolos que representan velocidades siempre indicarán la veloci¬ 
dad en la trama de diferenciación y no tendrán superíndices externos a la izquierda. 

En vez de considerar la velocidad de un punto general relativa a una trama arbi¬ 
traria, muy a menudo consideraremos la velocidad del origen de una trama relativo a 
alguna trama de referencia universal que pueda comprenderse. Para este caso especial 
definiremos una notación abreviada, 

V C — Uy CORG > (5-5) 


en donde el punto en cuestión es el origen de la trama {Cj y la trama de referencia es 
{ U}. Por ejemplo, podemos usar la notación v c para referirnos a la velocidad del origen 
de la trama ¡C¡; entonces A v c es la velocidad del origen de la trama ¡Cj expresada en 
términos de la trama {A} (aunque la diferenciación se hizo con referencia a ¡C/¡). 
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FIGURA 5.1: Ejemplo de algunas tramas en movimiento lineal. 


EJEMPLO 5.1 

La figura 5.1 muestra una trama universal fija {[/), una trama {7¡ unida a un tren que 
viaja a 100 mph y una trama ¡C¡ unida a un auto que viaja a 30 mph. Ambos vehículos 
se dirigen en la misma dirección A de ¡f/¡. Las matrices de rotación '¡R y ¿R se cono¬ 
cen y son constantes. 

U d „ 

¿Cuál es el valor de — u Pqorg• 

u j 

_ U p _ U y _ . _ -JOY 

r CORG ~ v CORG ~ V C ~ JUA • 

¿Cuál es el valor de c ( u V TORG )? 

C ( U Vtorg ) = C ”t = u Rv t =£ *(100Á) = u c R~ l 100X. 


¿Cuál es el valor de C ( T v coRG,y- 


C (T V 

*■ v CORG 


) = c T R T v, 


CORG 


-Vr - 1 vriox. 


El vector de velocidad angular 

Ahora presentaremos un vector de velocidad angular que utiliza el símbolo Q. Mientras 
que la velocidad lineal describe un atributo de un punto, la velocidad angular describe 
un atributo de un cuerpo. Siempre unimos una trama a los cuerpos que consideramos, 
por lo que también podemos pensar que la velocidad angular describe el movimiento 
giratorio de una trama. 

En la figura 5.2, A Q. B describe la rotación de la trama ¡5¡ relativa a la trama ¡Aj. 
Eísicamente, en cualquier instante la dirección de A Q. B indica el eje instantáneo de ro¬ 
tación de ¡5¡ relativo a ¡A), y la magnitud de A Q. B indica la velocidad de rotación. De 
nuevo y como en cualquier vector, un vector de velocidad angular puede expresarse en 
cualquier sistema de coordenadas, por lo que puede agregarse otro superíndice a la iz¬ 
quierda; por ejemplo, C ( A Q. B ) es la velocidad angular de la trama ¡5j relativa a {A}, ex¬ 
presada en términos de la trama ¡Cj. 
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FIGURA 5.2: La trama {5} gira con la velocidad angular A Q. B relativa a la trama ¡A). 

De nuevo, introduciremos una notación simplificada para un caso especial impor¬ 
tante. Éste es simplemente el caso en el que hay una trama de referencia conocida, de 
manera que no necesita mencionarse en la notación: 



(5.6) 


Aquí (ü c es la velocidad angular de la trama ¡Cj relativa a cierta trama de referencia co¬ 
nocida ¡f/). Por ejemplo, A co c es la velocidad angular de la trama ¡C) expresada en tér¬ 
minos de ¡A) (aunque la velocidad angular es con respecto a ¡t/j). 

5.3 VELOCIDAD LINEAL Y ROTACIONAL DE CUERPOS RÍGIDOS 

En esta sección, investigaremos la descripción del movimiento de un cuerpo rígido, 
cuando menos en lo que respecta a la velocidad. Estas ideas extienden las nociones de 
traslaciones y orientaciones descritas en el capítulo 2 al caso en el que hay variación con 
el tiempo. En el capítulo 6 extenderemos aún más nuestro estudio para considerar la 
aceleración. 

Al igual que en el capítulo 2, unimos un sistema de coordenadas a cualquier cuer¬ 
po que deseemos describir. De esta manera, el movimiento de los cuerpos rígidos pue¬ 
de estudiarse de manera equivalente al movimiento de las tramas relativas entre sí. 

Velocidad lineal 

Considere una trama ¡5) unida a un cuerpo rígido. Deseamos describir el movimiento 
de B Q respecto a la trama {Aj, como se muestra en la figura 5.3. Podemos considerar 
que ¡Aj es fija. 

La trama {B¡ se ubica de manera relativa a ¡Aj como lo describe un vector de po¬ 
sición a P borg y una matriz de rotación ^ R. De momento, supondremos que la orien¬ 
tación A g R no cambia con el tiempo; esto es, el movimiento del punto Q respecto a {Aj 
se debe a que A P BORG o B Q cambian con el tiempo. 

Es bastante simple resolver para la velocidad lineal del punto Q en términos de {Aj. 
Sólo se expresan ambos componentes de la velocidad en términos de {Aj y se suman: 



(5.7) 


La ecuación (5.7) es solamente para el caso en el que la orientación relativa de {5} y 
{Aj permanece constante. 
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FIGURA 5.3: La trama ¡B¡ se traslada con la velocidad A V BORG relativa a la trama {A}. 


Velocidad de rotación 

Ahora consideremos dos tramas con orígenes coincidentes y velocidad relativa lineal 
cero; sus orígenes permanecerán coincidentes en todo momento. Una o ambas podrían 
estar fijas a cuerpos rígidos pero, por claridad, los cuerpos rígidos no se muestran en la 
figura 5.4. 

La orientación de la trama ¡B¡ con respecto a la trama |A¡ está cambiando en el 
tiempo. Como se indica en la figura 5.4, la velocidad de rotación de ¡5) relativa a |A¡ 
es descrita por un vector llamado A Q B - También hemos indicado un vector 11 Q que lo¬ 
caliza un punto fijo en ¡B). Ahora consideremos la pregunta más importante: ¿cómo cam¬ 
bia un vector con el tiempo según se ve desde |A¡ cuando está fijo en ¡Bj y los sistemas 
están rotando? 

Consideremos que el vector Q es constante viéndolo desde la trama ¡Bj; esto es, 

b V q =0. (5.8) 

Aunque es constante de manera relativa a ¡B¡, está claro que el punto Q tendrá una ve¬ 
locidad como se ve desde {A} debido a la velocidad rotacional A Q. B Para conocer la 
velocidad del punto Q, usaremos una aproximación intuitiva. La figura 5.5 muestra dos 
fracciones de tiempo, mientras el vector Q gira alrededor de A Q . B . Esto es lo que un ob¬ 
servador vería en {A}. 


B Q 



FIGURA 5.4: El vector B Q fijo en la trama ¡Bj está girando respecto a la trama {A} con 
una velocidad angular a O- b . 
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FIGURA 5.5: La velocidad de un punto debido a una velocidad angular. 

Al examinar la figura 5.5 podemos averiguar tanto la dirección como la magnitud 
del cambio en el vector, visto desde {A}. En primer lugar, está claro que el cambio di¬ 
ferencial en A Q debe ser perpendicular tanto a A Q. B como a A Q. En segundo lugar, po¬ 
demos ver gracias a la figura 5.5 que la magnitud del cambio diferencial es 

|Ag| = (| A G|sen0)(| A í2 B |Aí). (5.9) 

Estas condiciones sobre magnitud y dirección sugieren inmediatamente el producto 
cruz de los vectores. Evidentemente, nuestras conclusiones sobre dirección y magnitud 
se satisfacen mediante la siguiente forma computacional: 

a V q = a í2 b x a Q. (5.10) 

En el caso general, el vector Q también podría estar cambiando respecto a la trama ¡5¡, 
por lo que si sumamos este componente tenemos que: 

A V q = a ( b V q ) + a Q b x a Q. (5.11) 

Si utilizamos una matriz de rotación para eliminar el doble superíndice y, teniendo en 
cuenta que la descripción de A Q en cualquier instante es B R B Q , terminamos con 

Ay Q = b R By Q +A ^B x b r B Q- (5-12) 

Velocidad lineal y de rotación simultáneas 

Podemos expandir de manera muy simple la ecuación (5.12) para el caso en el que los 
orígenes no son coincidentes; sumando la velocidad lineal del origen a la ecuación 
(5.12) para derivar la fórmula general para la velocidad de un vector fijo en la trama 
[5¡, visto desde la trama ¡A): 

% = Á V BORG + a R b V q + a Q b x a R b Q 


(5.13) 
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La ecuación (5.13) es el resultado final para la derivada de un vector en una trama mó¬ 
vil, visto desde una trama estacionaria. 

5.4 MÁS SOBRE LA VELOCIDAD ANGULAR 

En esta sección daremos un vistazo más detallado a la velocidad angular y, en especial, 
a la derivación de (5.10). Mientras que en la sección anterior tomamos un método geo¬ 
métrico para demostrar la validez de la ecuación (5.10), aquí lo haremos con uno ma¬ 
temático. Si es la primera vez que lee este libro, puede omitir esta sección. 

Una propiedad de la derivada de una matriz ortonormal 

Podemos obtener una interesante relación entre la derivada de una matriz ortonormal 
y cierta matriz antisimétrica como se muestra a continuación. Para cualquier matriz or¬ 
tonormal denxn de nombre R , tenemos que 

RR t = /„ (5.14) 

en donde / es la matriz de identidad de n x n. Por cierto, a nosotros nos interesa el ca¬ 
so en el que n — 3 y R es una matriz ortonormal propia, o matriz de rotación. Si dife¬ 
renciamos la ecuación (5.14) nos queda 

RR t + RR t = 0„, (5.15) 

en donde 0 es la matriz cero de n x n. La ecuación (5.15) también puede escribirse así: 

RR t + (RR t ) t = 0„. (5.16) 

Definiendo 

S = RR t , (5.17) 

de la ecuación (5.16) tenemos que 

S+S 7 " = 0„. (5.18) 

Por lo tanto, podemos ver que S es una matriz antisimétrica. Por consecuencia existe 
una propiedad que relaciona la derivada de las matrices ortonormales con las matrices 
antisimétricas, y puede declararse así: 

S = RR~ 1 . (5.19) 

Velocidad de un punto debido a una trama de referencia giratoria 

Considere un vector fijo B P que no cambia respecto a la trama ¡5¡. Su descripción en 
otra trama {A} se da así: 

A P = A R B P. (5.20) 

Si la trama ¡5¡ está girando (lo que implica que la derivada j¡R es distinta de cero), en¬ 
tonces A P estaría cambiando aunque B P fuera constante; esto es, 

a 'p = a b r b p, 

o, utilizando nuestra notación para velocidad, 


(5.21) 
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Ahora vamos a rescribir la ecuación (5.22) sustituyendo para B P, para obtener 

a V p =*R a b R- 1a P. (5.23) 

Haciendo uso de nuestro resultado (5.19) para matrices ortonormales, tenemos que: 

A V P = A S A P , (5.24) 

en donde hemos adornado a S con subíndices y superíndices para indicar que es la ma¬ 
triz antisimétrica asociada con la matriz de rotación específica A , R. Debido a su apari¬ 
ción en la ecuación (5.24) y por otras razones que veremos en breve, a la matriz 
antisimétrica que hemos presentado se le llama matriz de velocidad angular. 


Las matrices antisimétricas y el producto cruz de vectores 

Si asignamos los elementos en una matriz antisimétrica S como 


S = 


0 -Q x Q y 
Q O' —Q 

-Q y % o' 


y definimos el siguiente vector columna de 3 x 1: 


£2 = 


% 

£ 2 _ 


entonces puede verificarse fácilmente que 


SP = £2 x P, 


(5.25) 


(5.26) 


(5.27) 


en donde P es un vector arbitrario y x denota la operación de producto cruz o vectorial. 

Al vector £2 de 3 x 1, que corresponde a la matriz de velocidad angular de 3 x 3, 
se le llama vector de velocidad angular y ya lo habíamos presentado en la sección 5.2. 
Por ende, nuestra relación (5.24) puede escribirse así: 


A V P = a Q. b x A P, (5.28) 

en donde hemos mostrado la notación para £2, indicando que es el vector de velocidad 
angular que especifica el movimiento de la trama ¡B¡ respecto a la trama {A}. 


Interpretación física del vector de velocidad angular 

Habiendo concluido que existe cierto vector £2 que satisface la ecuación (5.28), pode¬ 
mos ahora interpretar su significado físico. Derive £2 por diferenciación directa de una 
matriz de rotación; esto es, 


R = 


„ R(t + At)-R(t) 

lim - 

Ar-»0 A t 


(5.29) 


Ahora escriba R(t + A t) como la composición de dos matrices, a saber: 


R(t + A t) = R K (A6)R(t), 


( 5 . 30 ) 
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en donde durante el intervalo Ai ocurre una pequeña rotación de A 6 sobre el eje K. Uti¬ 
lizando la ecuación (5.30) escriba la (5.29) así: 

(5.31) 


R = lím ( Rk(A6) - ÜR(t) ) ; 

A?—>-0 


A t 


esto es, 


R = ( lím 

i Aí->0 


R K (A9) 
A t 


R(t). 


(5.32) 


Ahora, basándonos en pequeñas sustituciones de ángulos en la ecuación (2.80) tenemos que 

1 ~k z A0 k A9 


R k (A6) = 


1 —k x A9 
—k y A9 k x A9 1 


k z A9 


(5.33) 


Así, la ecuación (5.32) puede escribirse como 


/ 


R = 


lím 

Ai—*0 


0 


-k,A9 k y A9 


k,A9 
-k A9 k x A9 


0 -k x A9 
0 


A t 


R(t). 


(5.34) 


V 

Finalmente, dividiendo la matriz entre A t y después tomando el límite, tenemos que 


R = 


0 

-k z 9 

k y e ' 



k z 9 

0 

-k x é 

R(t). 

(5.35) 

-k Ó 

k x 9 

0 




Por ende, podemos ver que 


RR- 1 


I) 

-Í2„ 


-£2_ Q v 

z y 

0 -Q.. 


£2, 


en donde 



"£2," 


- k x 9 - 

= 


= 

kJ 


UJ 


1 

_1 


0 


= 9K. 


(5.36) 


(5.37) 


El significado físico del vector de velocidad angular Q. es que, en cualquier instante, el 
cambio en orientación de una trama giratoria puede verse como una rotación sobre 
determinado eje K. Este eje instantáneo de rotación, si se toma como un vector unita¬ 
rio y después se le aplica una escala mediante la velocidad de rotación sobre ese otro 
eje (9), produce el vector de velocidad angular. 


Otras representaciones de la velocidad angular 


Puede ser posible que existan otras representaciones de la velocidad angular; por ejem¬ 
plo, imagine que la velocidad angular de un cuerpo giratorio está disponible en forma 
de proporciones del conjunto de ángulos de Euler Z-Y-Z: 


© 


Z'Y'Z' 



(5.38) 
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Dado este modo de representación o cualquier otro que utilice alguno de los 24 conjuntos 
de ángulos, podría ser conveniente derivar el vector de velocidad angular equivalente. 
Hemos visto que 


RR t 


0 -Q z Q y 
Í2, 0 ~ -£2 X 

-á y Q x o' 


(5.39) 


A partir de esta matriz de ecuación se pueden extraer tres ecuaciones independientes: 


— r 31 r 21 + r 32 r 22 + r 33 r 23> 

S2, = / 'll r 31 + '\2 r 32 + r 13 r 33’ (5.40) 

= r 2\ r l\ + r 22 r l2 + r 23 r 13- 

De la ecuación (5.40) y una descripción simbólica de R en términos de un conjunto de án¬ 
gulos, podemos obtener las expresiones que relacionan las velocidades de establecimien¬ 
to de ángulos con el vector de velocidad angular equivalente. Las expresiones resultantes 
pueden convertirse a forma matricial; por ejemplo, para los ángulos de EulerZ-Y-Z, 


Q = 


Ez'Y'Z'(®Z'Y'Z')®Z'Y’Z’- 


(5.41) 


Esto es, E(-) es un jacobiano que relaciona un vector de velocidad definido a partir del 
conjunto de ángulos con el vector de velocidad angular y es una función de los valores 
instantáneos del ángulo establecido. La forma de £(•) depende del ángulo establecido 
para el que haya sido desarrollado; por lo tanto, se agrega un subíndice para indicarlo. 


EJEMPLO 5.2 

Construya la matriz E que relacione los ángulos de Euler Z-Y-Z con el vector de velo¬ 
cidad angular; esto es, encuentre E z , y , z , en la ecuación (5.41). 

Utilizando las ecuaciones (2.72) y (5.40) y realizando las diferenciaciones simbó¬ 
licas requeridas, tenemos que 


E Z 'y'z' 


0 — sa cas/3 
0 ca sas/3 
1 0 cP 


(5.42) 


5.5 MOVIMIENTO DE LOS VÍNCULOS DE UN ROBOT 

Al considerar los movimientos de los vínculos de un robot, siempre utilizaremos la 
trama de vínculo {0} como nuestra trama de referencia. Por lo tanto, v i es la veloci¬ 
dad lineal del origen de la trama del vínculo {/}, y a> ¡ es la velocidad angular de la tra¬ 
ma del vínculo {/). 

En cualquier instante, cada uno de los vínculos de un robot en movimiento tiene 
cierta velocidad lineal y angular. La figura 5.6 indica estos vectores para el vínculo i. En 
este caso se indica que están escritos en la trama {/}. 

5.6 "PROPAGACIÓN" DE VELOCIDAD DE VÍNCULO A VÍNCULO 

Ahora consideremos el problema de calcular las velocidades lineal y angular de los 
vínculos de un robot. Un manipulador es una cadena de cuerpos, cada uno capaz de 
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Eje i 



\ 

\ 


FIGURA 5.6: La velocidad del vínculo i se da mediante los vectores v ( - y co i , que pueden 
escribirse en cualquier trama, incluso en {/}. 


moverse en relación a sus cuerpos adyacentes. Debido a esta estructura podemos 
calcular la velocidad de cada vínculo en orden, empezando desde la base. La velocidad 
del vínculo i + 1 será la del vínculo i más cualquier nuevo componente de velocidad que 
se haya agregado por la articulación i + 1. 2 

Según lo que se indica en la figura 5.6, vamos a pensar ahora en cada vínculo del 
mecanismo como si fuera un cuerpo rígido con vectores de velocidad lineal y angular 
que describen su movimiento. Además, expresaremos estas velocidades respecto a la 
trama del vínculo en sí, en vez de hacerlo respecto al sistema de coordenadas base. La 
figura 5.7 muestra los vínculos i e i + 1, junto con sus vectores de velocidad definidos en 
las tramas de los vínculos. 

Pueden agregarse velocidades de rotación cuando ambos vectores co se escriben 
respecto a la misma trama. Por lo tanto, la velocidad angular del vínculo i + 1 es la misma 



FIGURA 5.7: Vectores de velocidad de los vínculos adyacentes. 


2 Recuerde que la velocidad lineal se asocia con un punto, pero la velocidad angular está asociada con 
un cuerpo. Por lo tanto, aquí el término “velocidad de un vínculo” indica la velocidad lineal del origen de la 
trama del vínculo y la velocidad de rotación del mismo. 
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que la del vínculo i más un nuevo componente producido por la velocidad de rotación 
en la articulación i + 1. Esto puede escribirse en términos de la trama {/} como 




í+t 


Cü: 




i+1 


z, 


i+i- 


(5.43) 


Observe que 


0 ; 


1+1 


1+1 


Z l+t = 


_ 1+1 


0 

o 

L ¿i+i 


(5.44) 


Hemos utilizado la matriz de rotación que relaciona a las tramas {/} e {i + 1} para re¬ 
presentar el componente de rotación agregado, debido al movimiento de la articulación 
en la trama {/}. La matriz de rotación gira el eje de rotación de la articulación i + 1 ha¬ 
cia su descripción en la trama {/), por lo que pueden sumarse los dos componentes de 
velocidad angular. 

Si multiplicamos previamente ambos lados de la ecuación (5.43) por ' + 1 R, pode¬ 
mos encontrar la descripción de la velocidad angular del vínculo i + 1 respecto a la tra¬ 
ma {/ + lj: 


Í+ X+l = Í+ )R X + 4+1 Í+1 Z i+ v (5-45) 

La velocidad lineal del origen de la trama {/ + lj es la misma que la del origen de la tra¬ 
ma {/} más un nuevo componente producido por la velocidad de rotación del vínculo i. 
Ésta es exactamente la situación descrita por la ecuación (5.13), en donde desaparece 
un término debido a que ‘P ¡+1 es constante en la trama {/}. Por lo tanto, tenemos que 

X + t = X+X x*\p ;+1 . (5.46) 

Si multiplicamos previamente ambos lados por 1+1 ¡R, calculamos 

Í+ \+i = i+ ] R (' v i + X x X +1 ). (5.47) 

Las ecuaciones (5.45) y (5.47) son tal vez los resultados más importantes de este capítulo. Las 
relaciones correspondientes para el caso en el que la articulación i + 1 es prismática son 

,+ X+t = i+ ) R X- 

i+ x +1 = i+ ;*(X+x x x +1 )+4+t ! ' + x+i- ( 5 - 48 ) 

Si aplicamos estas ecuaciones exitosamente de vínculo en vínculo, podremos entonces 
calcular N co N y N v N , las velocidades de rotación y lineal del último vínculo. Observe que 
las velocidades resultantes se expresan en términos de la trama ¡iV¡. Esto resulta útil, 
como veremos posteriormente. Si las velocidades se desean en términos del sistema 
de coordenadas base, pueden girarse hacia coordenadas base mediante la multiplica¬ 
ción con^i?. 


EJEMPLO 5.3 

En la figura 5.8 se muestra un manipulador de dos vínculos con articulaciones girato¬ 
rias. Calcule la velocidad de la punta del brazo como función de las velocidades de ar¬ 
ticulación. Dé la respuesta en dos formas: en términos de la trama ¡3) y en términos de 
la trama ¡0¡. 

Se ha unido la trama {3} al extremo del manipulador, como se muestra en la figu¬ 
ra 5.9, y deseamos encontrar la velocidad del origen de esta trama expresada en la 
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FIGURA 5.8: Un manipulador de dos vínculos. 


x 3 



FIGURA 5.9: Asignaciones de tramas para el manipulador de dos vínculos. 


trama {3}. Como segunda parte del problema expresaremos estas velocidades en la tra¬ 
ma {0} también. Empezaremos asignando tramas a los vínculos, como hicimos antes 
(esto se muestra en la figura 5.9). 

Utilizaremos las ecuaciones (5.45) y (5.47) para calcular la velocidad del origen de 
cada trama, empezando desde la trama base ¡0¡, que tiene una velocidad de cero. Como 
en las ecuaciones (5.45) y (5.47) vamos a utilizar las transformaciones de vínculo, hay 
que calcularlas: 


o 

i 


T = 


1 

2 


T = 


2 

3 


T = 


Cj — í 1 0 0 
Sj 0 0 

0 0 10 ’ 
0 0 0 1 

c 2 ~ s 2 0 l] 

S 2 C 2 0 0 
0 0 10 ’ 
0 0 0 1 

1 0 0 l 2 ~ 

0 10 0 
0 0 10 ■ 

0 0 0 1 


(5.49) 
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Observe que éstas corresponden al manipulador del ejemplo 3.3 con la articulación 3 
permanentemente fija a cero grados. La transformación final entre las tramas {2} y {3} 
no necesita convertirse en transformación de vínculo estándar (aunque podría ser útil 
hacerlo). Entonces, utilizando las ecuaciones (5.45) y (5.47) en forma secuencial de 
vínculo en vínculo, calculamos 


v i 


0 

0 

L®t 

0' 

0 

o 


®2 = 


-u 2 = 


0 

o 

¿i + é 2 


c 2 S 2 0 

s 2 c 2 0 
0 0 1 


o 

IÁ 

o 


v 3 = 


(ti 2 , 

h s 2®\ 

h c 2®\ + + Ó 2 ) 

0 


^l s 2^1 

^l c 2^1 

0 


(5.50) 

(5.51) 

(5.52) 

(5.53) 

(5.54) 

(5.55) 


La ecuación (5.55) es la respuesta. Además, la velocidad de rotación de la trama {3} se 
encuentra en la ecuación (5.54). 

Para encontrar estas velocidades respecto a la trama base inmóvil, las giramos con 
la matriz de rotación { \R'. 


o 

3 


R = 


R 


\R 



c 12 ^12 0 
5 12 c 12 0 
0 0 1 


(5.56) 


Esta rotación produce lo siguiente: 


o 


v 3 


~h s i?i ~ h s n(?i +.^ 2 ) 
k c lÓl + ¡2 C 12^1 + ^2) 
0 


(5.57) 


Es importante señalar los dos usos para las ecuaciones (5.45) y (5.47). En primer 
lugar, pueden usarse como un medio para derivar expresiones analíticas, como en el 
ejemplo 5.3. Aquí manipulamos las ecuaciones simbólicas hasta llegar a una forma tal 
como (5.55), que se evaluará con una computadora en alguna aplicación. En segundo 
lugar, pueden usarse directamente para calcular las ecuaciones (5.45) y (5.47) a medi¬ 
da que se vayan escribiendo. Pueden escribirse fácilmente como una subrutina, la cual 
se aplica después en forma iterativa para calcular las velocidades de los vínculos. Co¬ 
mo tales, podrían utilizarse para cualquier manipulador sin la necesidad de deducir las 
ecuaciones para un manipulador específico. No obstante, el cálculo produce entonces 
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un resultado numérico con la estructura de las ecuaciones oculta. A menudo nos inte¬ 
resa la estructura de un resultado analítico tal como la ecuación (5.55). Además, si nos 
molestamos en hacer el trabajo [esto es, las ecuaciones (5.50) a (5.57)], generalmente 
encontraremos que habrá menos cálculos pendientes para que los lleve a cabo la compu¬ 
tadora en la aplicación final. 

5.7 JACOBIANOS 

El jacobiano es una forma multidimensional de la derivada. Por ejemplo, suponga que tene¬ 
mos seis funciones, cada una de las cuales es una función de seis variables independientes: 

A = f 1 (x 1 ,x 2 ,x 3 ,x 4 ,x 5 ,x 6 ), 

y 2 = f 2 ( Xl ,X 2 ,X 3 ,X 4 ,X 5 ,X 6 ), 


(5.58) 


Ye = f 6 (x 1 ,x 2 ,x 3 ,x 4 ,x 5 ,x 6 ). 


También podríamos usar notación vectorial para escribir estas ecuaciones: 

Y = F{X). (5.59) 


Ahora, si deseamos calcular los diferenciales de en función de los diferenciales de x„ 
simplemente utilizamos la regla de cadena para calcular y obtener: 

dx 2 ‘ 

3/2 


o 3/l o 
íy, = —¿y, 


3/1 

-Sx 2 + ■ ■ ■ + - — Sx 6 , 
3*6 


3A 

ay 2 = —éx, 


dx- 


■Sx 9 + • • • + 


3 h 

3 X, 


S Xf¡ , 


. 3 fe, 

íy„ = —¿x, 


% 

dx-? 


Sx 2 + • • • + 


3 fe 
dx 


Sx,, 


(5.60) 


lo cual podría escribirse con más simplicidad en notación vectorial: 

SY = —SX. (5.61) 

dX 

La matriz de 6 x 6 de derivadas parciales en la ecuación (5.61) es lo que llamamos el 
jacobiano,/. Observe, que si las funciones f x (X) a f 6 (X) son no lineales, entonces las de¬ 
rivadas parciales son una función de las x„ por lo que podemos usar la notación 

<57 = J(X)SX. (5.62) 

Al dividir ambos lados por el elemento tiempo diferencial, podemos pensar en el jaco¬ 
biano como una asignación o mapeo de las velocidades en A a las velocidades en Y: 

Y = J(X)X. (5.63) 

En cualquier instante específico, X tiene cierto valor y J(X) es una transformación li¬ 
neal. En cada nuevo instante de tiempo X ha cambiado y, por lo tanto, también ha cam¬ 
biado la transformación lineal. Los jacobianos son transformaciones lineales que varían 
en el tiempo. 
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En el campo de la robótica, generalmente usamos jacobianos que relacionan velo¬ 
cidades de articulaciones con velocidades cartesianas en la punta del brazo; por ejemplo: 

°v = 0 ./(©)©, (5.64) 


en donde © es el vector de ángulos de articulación del manipulador y v es un vector de 
velocidades cartesianas. En la ecuación (5.64) hemos agregado un superíndice a la iz¬ 
quierda a nuestra notación jacobiana para indicar en qué trama se expresa la velocidad 
cartesiana resultante. Algunas veces el superíndice se omite cuando la trama es obvia 
o cuando no es importante para el desarrollo. Tenga en cuenta que, para cualquier con¬ 
figuración dada del manipulador, las proporciones de articulación están relacionadas 
con la velocidad de la punta en modo lineal, aunque ésta es solamente una relación ins¬ 
tantánea; en el siguiente instante, el jacobiano ha cambiado ligeramente. Para el caso 
general de un robot con seis articulaciones el jacobiano es de 6 x 6, 0 es de 6 x 1 y °v 
es de 6 x 1. Este vector de velocidad cartesiana de 6 x 1 es el vector de velocidad li¬ 
neal de 3 x 1 y el vector de velocidad de rotación de 3 x 1 apilados: 

°v=r 0 n ( 5 - 65 ) 

CÜ 

Pueden definirse jacobianos de cualquier dimensión (incluyendo los no cuadrados). El 
número de filas es igual al número de grados de libertad en el espacio cartesiano que 
se esté considerando. El número de columnas en un jacobiano es igual al número de ar¬ 
ticulaciones del manipulador. Por ejemplo, al tratar con un brazo planar no hay razón 
para que el jacobiano tenga más de tres filas, aunque para los manipuladores planares 
redundantes podrían haber un número arbitrariamente grande de columnas (una para 
cada articulación). 

En el caso de un brazo de dos vínculos podemos escribir un jacobiano de 2 x 2 que 
relacione las proporciones de articulación con la velocidad del efector final. Del resulta¬ 
do del ejemplo 5.3 podemos fácilmente determinar el jacobiano de nuestro brazo de dos 
vínculos. El jacobiano escrito en la trama {3} sería entonces [de la ecuación (5.55)]: 


V(©) = 


¡^2 0 

. ^i c 2 + h h 

y el jacobiano escrito en la trama [0¡ sería [de la ecuación (5.57)]: 


V(0) = 


~ l l s 1 ~ h s 12 ~ 1 2 S Í2 
h c l+h c 12 l 2 c 12 


(5.66) 


(5.67) 


Observe que, en ambos casos, hemos optado por escribir una matriz cuadrada que rela¬ 
cione las velocidades de articulación con la velocidad del efector final. También podríamos 
considerar un jacobiano de 3 x 2 que incluyera la velocidad angular del efector final. 

Considerando las ecuaciones (5.58) a (5.62) que definen el jacobiano, podemos 
ver que éste podría encontrarse también al diferenciar directamente las ecuaciones 
cinemáticas del mecanismo. Esto es simple para la velocidad lineal, pero no hay un vec¬ 
tor de orientación de 3 x 1 cuya derivada sea co. Por ende, hemos introducido un mé¬ 
todo para derivar el jacobiano utilizando la aplicación sucesiva de las ecuaciones (5.45) 
y (5.47). Hay varios métodos más que pueden usarse (vea, por ejemplo, la referencia 
bibliográfica [4]), uno de los cuales se presentará posteriormente en la sección 5.8. Una 
razón para derivar jacobianos mediante el método presentado es que nos prepara para 
el material del capítulo 6, en el cual encontraremos que se aplican técnicas similares pa¬ 
ra calcular las ecuaciones dinámicas del movimiento de un manipulador. 
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Cómo cambiar la trama de referencia de un jacobiano 

Dado un jacobiano escrito en la trama ¡5), es decir, 

= B v = B J(@)é, (5.68) 

podría ser conveniente proporcionar una expresión para el jacobiano en otra trama, 
¡Aj. En primer lugar, observe que un vector de velocidad cartesiana de 6 x 1 dado en 
¡5j se describe en términos de {A j mediante la siguiente transformación: 



A ul 


A p 
b R 

1 

o 


\ B v 

A «J 


1 

O 

A p 

b R J 


[ B co 


Por ende, podemos escribir 


(5.69) 


A ul 


~b r 

0 

A «J 


1 

o 

b R 


Ahora queda claro que para cambiar la trama de 
la siguiente relación: 


( 5 - 70 ) 

referencia de un jacobiano se utiliza 


A J(®) = 


A K 

0 

B 

0 

A p 

B R 




(5.71) 


5.8 SINGULARIDADES 

Si tenemos una transformación lineal que relacione la velocidad de articulación con la 
velocidad cartesiana, una pregunta razonable sería: ¿es invertible esta matriz? Es decir, 
¿es no singular? Si la matriz es no singular, entonces podemos invertirla para calcular 
las velocidades de articulación a partir de las velocidades cartesianas dadas: 

© = / -1 (©) v. (5.72) 

Esta es una importante relación. Por ejemplo, suponga que deseamos que la mano del 
robot se mueva con un cierto vector de velocidad en espacio cartesiano. Utilizando la 
ecuación (5.72) calcularíamos las proporciones de articulación necesarias en cada ins¬ 
tante a lo largo de la ruta. La pregunta real de invertibilidad sería: ¿es invertible el ja¬ 
cobiano para todos los valores de ©? Si no, ¿en dónde no es invertible? 

La mayoría de los manipuladores tiene valores de © para los que el jacobiano se 
vuelve singular. Dichas ubicaciones se llaman singularidades del mecanismo, o simple¬ 
mente singularidades. Todos los manipuladores tienen singularidades en los límites o 
frontera de su espacio de trabajo, y la mayoría tienen regiones de singularidad dentro 
de su espacio de trabajo. Un estudio a profundidad de la clasificación de las singulari¬ 
dades estaría más allá del alcance de este libro; para obtener más información, vea la 
referencia [5]. Para fines de este libro y sin dar definiciones rigurosas, clasificaremos las 
singularidades en dos categorías: 

1. Singularidades en la frontera del espacio de trabajo: ocurren cuando el manipu¬ 
lador está completamente extendido o doblado sobre sí mismo, en tal forma que 
el efector final se encuentra en o muy cerca de los límites del espacio de trabajo. 
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2. Singularidades dentro del espacio de trabajo: ocurren lejos de los límites del es¬ 
pacio de trabajo; generalmente se producen por el alineamiento de dos o más ejes 
de articulación. 

Cuando un manipulador se encuentra en una configuración singular, ha perdido 
uno o más grados de libertad (viéndolo desde el espacio cartesiano). Esto significa que 
hay cierta dirección (o subespacio) en el espacio cartesiano sobre la cual es imposible 
mover la mano del robot, sin importar qué proporciones de articulación estén seleccio¬ 
nadas. Es obvio que esto ocurre en la frontera del espacio de trabajo de los robots. 


EJEMPLO 5.4 

¿En dónde están las singularidades del brazo simple de dos vínculos del ejemplo 5.3? 
¿Cuál es la explicación física de las singularidades? ¿Son singularidades en la frontera 
del espacio de trabajo o singularidades dentro del espacio de trabajo? 

Para encontrar los puntos singulares de un mecanismo, debemos examinar el de¬ 
terminante de su jacobiano. En los puntos en los que el determinante es igual a cero, el 
jacobiano ha perdido todo el rango y es singular. 


DET[J(@)] = 


l\ s 2 0 

h c 2 + h h 


— hh s 2 — 0. 


(5.73) 


Evidentemente existe una singularidad del mecanismo cuando 0 2 es 0 o 180 grados. Fí¬ 
sicamente, cuando d 7 — 0 el brazo está completamente extendido. En esta configura¬ 
ción es posible mover el efector final sobre una dirección cartesiana solamente (la que 
sea perpendicular al brazo). Por lo tanto, el mecanismo ha perdido un grado de li¬ 
bertad. De igual forma, cuando 0 2 = 180 el brazo está completamente retractado y es 
posible moverlo de nuevo solamente en una dirección cartesiana, y no en dos. Clasi¬ 
ficaremos a éstas como singularidades en la frontera del espacio de trabajo, ya que exis¬ 
ten en el borde del espacio de trabajo del manipulador. Observe que el jacobiano escrito 
con respecto a la trama ¡0j, o a cualquier otra trama, hubiera producido el mismo re¬ 
sultado. 


El peligro al aplicar la ecuación (5.72) en un sistema de control de robots es que, 
en un punto singular, ¡el jacobiano inverso estalla! Esto ocasiona que las velocidades 
de articulación se acerquen al infinito, a medida que se llega a la singularidad. 


EJEMPLO 5.5 

Considere el robot de dos vínculos del ejemplo 5.3, a medida que mueve su efector fi¬ 
nal a lo largo del eje Xa 1.0 m/s, como se muestra en la figura 5.10. Demuestre que las 
proporciones de articulación son razonables cuando se está lejos de una singularidad 
pero que, a medida que se acerca a una singularidad cuando 0 2 = 0, las proporciones de 
articulación tienden al infinito. 

Empezaremos calculando la inversa del jacobiano escrita en ¡0¡: 

h c n h s u 

~h c l ~ l 2 c 12 ~h s l - h s V2 _ 


°/- 1 ( 0 ) = 


h h s 2 


(5.74) 










Sección 5.9 


Fuerzas estáticas en los manipuladores 153 



FIGURA 5.10: Un manipulador de dos vínculos que mueve su punta a una velocidad li¬ 
neal constante. 

Entonces, utilizando la ecuación (5.74) para una velocidad de 1 m/s en la dirección X, 
podemos calcular las proporciones de articulación como una función de la configura¬ 
ción del manipulador: 

Ó i = f 11 , (5.75) 

h s 2 

Ó 2 = _^L_£12. 

^ 2^2 1^2 

Evidentemente, a medida que el brazo se extiende hacia 0 2 = 0, ambas proporciones de 
articulación se van a infinito. 


EJEMPLO 5.6 

Para el manipulador PUMA 560, proporcione dos ejemplos de singularidades que pue¬ 
den ocurrir. 

Hay singularidad cuando & 3 está cerca de -90.0 grados. Dejaremos como ejercicio 
el cálculo del valor exacto de 9 y (Vea el ejercicio 5.14). En esta situación, los vínculos 
2 y 3 se “extienden completamente”, justo igual que la ubicación singular del manipu¬ 
lador de dos vínculos del ejemplo 5.3. Esto se clasifica como una singularidad en los lí¬ 
mites del espacio de trabajo. 

Siempre que & 5 — 0.0 grados, el manipulador se encuentra en una configuración 
singular. En esta configuración, los ejes de articulación 4 y 6 se alinean; sus dos accio¬ 
nes producirían el mismo movimiento del efector final, por lo que es como si se hubie¬ 
ra perdido un grado de libertad. Como esto puede ocurrir dentro de la envoltura del 
espacio de trabajo, lo clasificaremos como singularidad dentro del espacio de trabajo. 


5.9 FUERZAS ESTÁTICAS EN LOS MANIPULADORES 

La naturaleza de tipo cadena de un manipulador nos lleva con mucha naturalidad a 
considerar cómo las fuerzas y los momentos se “propagan” de un vínculo al siguiente. 
Generalmente, el robot está empujando algo en el entorno con el extremo libre de la 
cadena (el efector final) o tal vez esté soportando una carga en la mano. Deseamos re¬ 
solver para los momentos de torsión de las articulaciones que deben estar actuando pa¬ 
ra mantener el sistema en equilibrio estático. 

Al considerar las fuerzas estáticas en un manipulador, primero bloqueamos todas 
las articulaciones para que el manipulador se convierta en una estructura. Después, 
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consideramos cada vínculo en esta estructura y escribimos una relación de balance 
fuerza-momento en términos de las tramas de los vínculos. Finalmente, calculamos qué 
momento de torsión estático debe estar actuando sobre el eje de articulación para 
que el manipulador pueda estar en equilibrio estático. De esta manera resolvemos pa¬ 
ra el conjunto de momentos de torsión de articulación necesarios para soportar una 
carga estática que actúe en el efector final. 

En esta sección no consideraremos la fuerza en los vínculos debida a la gravedad 
(dejaremos esto para el capítulo 6). Las fuerzas estáticas y momentos de torsión que es¬ 
tamos considerando en las articulaciones son aquellos producidos por una fuerza está¬ 
tica o momento de torsión (o ambos) que actúa sobre el último vínculo; por ejemplo, 
como cuando el manipulador pone a su efector final en contacto con el entorno. 

Definimos símbolos especiales para la fuerza y el momento de torsión ejercidos 
por un vínculo adyacente: 

f i = fuerza ejercida sobre el vínculo i por el vínculo i — 1. 

n ¡ = momento de torsión ejercido sobre el vínculo i por el vínculo i — 1. 

Utilizaremos nuestra convención usual para asignar tramas a vínculos. La figura 
5.11 muestra las fuerzas estáticas y momentos (excluyendo la fuerza de gravedad) que 
actúan sobre el vínculo i. Si sumamos las fuerzas y las hacemos iguales a cero, tenemos 


(5.76) 



Si sumamos los momentos de torsión sobre el origen de la trama {/'), tenemos 


(5.77) 



Si empezamos con una descripción de la fuerza y el momento aplicados por la mano, 
podemos calcular la fuerza y el momento aplicados por cada vínculo, trabajando desde 
el último hasta llegar a la base (vínculo 0). Para hacer esto, formulamos las expresiones 
de fuerza-momento (5.76) y (5.77) de tal forma que especifiquen iteraciones de los 
vínculos con mayor numeración hasta los vínculos con menor numeración. El resulta¬ 
do puede escribirse así: 



(5.78) 

(5.79) 


Para poder escribir estas ecuaciones sólo en términos de fuerzas y momentos definidos 
dentro de sus propias tramas de vínculos, transformamos con la matriz de rotación que 


(/ + 1 } 



FIGURA 5.11: Balance de fuerza-momento estático para un solo vínculo. 
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FIGURA 5.12: Un manipulador de dos vínculos, aplicando una fuerza en su punta. 

describe a la trama {/ + lj respecto a la trama {/). Esto produce nuestro resultado más 
importante para la “propagación” de fuerzas estáticas de vínculo en vínculo: 



(5.80) 

(5.81) 


Finalmente surge esta pregunta: ¿qué momentos de torsión se necesitan en las articu¬ 
laciones para poder balancear las fuerzas de reacción y los momentos que actúan sobre 
los vínculos? Todos los componentes de los vectores de fuerza y momento son resisti¬ 
dos por la estructura del mecanismo en sí, excepto por el momento de torsión sobre el 
eje de articulación. Por lo tanto, para encontrar el momento de torsión de articulación 
requerido para mantener el equilibrio estático, se calcula el producto punto del vector 
eje de articulación con el vector de momento que actúa sobre el vínculo: 



(5.82) 


En el caso en el que la articulación i sea prismática, calculamos la fuerza del actuador 
de articulación así: 



(5.83) 


Observe que estamos usando el símbolo r incluso para una fuerza de articulación lineal. 

Por convención, definimos la dirección positiva del momento de torsión de una 
articulación como la dirección en la que se movería la articulación en la dirección del 
ángulo de articulación creciente. 

Las ecuaciones (5.80) a la (5.83) nos proporcionan el medio para calcular los mo¬ 
mentos de torsión de articulación necesarios para aplicar cualquier fuerza o momento 
con el efector final de un manipulador en el caso estático. 


EJEMPLO 5.7 

El manipulador de dos vínculos del ejemplo 5.3 está aplicando un vector de fuerza 3 F 
con su efector final. (Considere que esta fuerza actúa en el origen de ¡3¡). Encuentre 
los momentos de torsión de articulación requeridos como una función de configuración 
y de la fuerza aplicada. (Vea la figura 5.12). 
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Aplicamos las ecuaciones (5.80) a (5.82), empezando desde el último vínculo y 
avanzando hacia la base del robot: 


72 


fx 

fy 

0 


n 2 ~ x 


7 

fy 


o 
o 


Vi = 


c 2 -s 2 0 

*2 c 2 0 

0 0 1 


—1 

_ 1 


c 2fx ~ S 2fy " 

fy 

= 

s 2Íx + c 2Íy 

0 


0 


(5.84) 

(5.85) 

(5.86) 

(5.87) 

(5.88) 

(5.89) 

(5.90) 


¡No es coincidencia que esta matriz sea la transpuesta del jacobiano que encontramos 
en la ecuación (5.66)! 


+ h^\ x f\ — 


0 
0 

h S lfx + h C 2fy + hf 


L h fy J 

Por lo tanto, tenemos que 

T 1 = h s 2fx + ( l 2 + h c Z>fy’ 

r 2 = hfy 

Esta relación puede escribirse como un operador matricial: 


y J 


h s 2 h + h c 2 

'fx ' 

. 0 l 2 

. fy. 


5.10 JACOBIANOS EN EL DOMINIO DE LA FUERZA 

Hemos encontrado momentos de torsión de articulación que balancearán exactamen¬ 
te las fuerzas en la mano en una situación estática. Cuando actúan fuerzas sobre un me¬ 
canismo, el trabajo (en el sentido técnico) se realiza si el mecanismo se mueve a través 
de un desplazamiento. El trabajo se define como una fuerza que actúa a través de una 
distancia y es un escalar con unidades de energía. El principio de trabajo virtual nos 
permite hacer ciertas aseveraciones sobre el caso estático al permitir que la cantidad de 
este desplazamiento se vuelva infinitesimalmente pequeña. El trabajo tiene unidades 
de energía, por lo que debe ser igual si se le mide en cualquier conjunto de coordena¬ 
das generalizadas. Específicamente, podemos igualar el trabajo realizado en términos 
cartesianos con el trabajo realizado en términos de espacio de articulación. En el caso 
multidimensional, el trabajo es el producto punto de una fuerza o momento de torsión 
vectorial y el desplazamiento de un vector. Por lo tanto, tenemos que: 

F-8 x = t-8@, (5.91) 

en donde T es un vector de fuerza-momento cartesiano de 6 x 1 que actúa en el efec- 
tor final, 8y es un desplazamiento cartesiano infinitesimal de 6 x 1 del efector final, r 
es un vector de 6 x 1 de momentos de torsión en las articulaciones y 5© es un vector 
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de 6 x 1 de desplazamientos infinitesimales de articulación. La expresión (5.91) tam¬ 
bién puede escribirse así: 



F r 8x = r t 8&. 

(5.92) 

La definición del jacobiano es 

8 X = J8&, 

(5.93) 

por lo que podemos escribir 

T t J80 = r r 8@, 

(5-94) 

lo cual debe ser válido para todos los <5©; por ende, tenemos que 



T t J = r T . 

(5.95) 

Si trasponemos ambos lados se produce este resultado: 



r = J t T. 

(5.96) 


La ecuación (5.96) verifica en general lo que vimos en el caso específico del manipulador 
de dos vínculos en el ejemplo 5.6: la transpuesta del jacobiano asigna fuerzas cartesianas 
que actúan en la mano, a momentos de torsión de articulación equivalentes. Cuando el 
jacobiano se escribe respecto a la trama {0} entonces los vectores de fuerza escritos en {0} 
pueden transformarse, como se clarifica mediante la siguiente notación: 

r = °J T °T. (5.97) 

Cuando el jacobiano pierde el rango completo, hay ciertas direcciones en las que el 
efector final no puede ejercer fuerzas estáticas, aun si se desea. Esto es, en la ecuación 
(5.97), si el jacobiano es singular, T podría incrementarse o reducirse en ciertas direc¬ 
ciones (aquellas que definen el espacio nulo del jacobiano [6]) sin efecto en el valor 
calculado para x. Esto también significa que cerca de configuraciones singulares, la ven¬ 
taja mecánica tiende hacia el infinito, por lo que con pequeños momentos de torsión de 
articulación podrían generarse grandes fuerzas en el efector final. 3 Por lo tanto, las sin¬ 
gularidades se manifiestan a sí mismas en el dominio de la fuerza así como en el domi¬ 
nio de la posición. 

Observe que la ecuación (5.97) es una relación muy interesante, ya que nos per¬ 
mite convertir una cantidad cartesiana en una cantidad en el espacio de articulación sin 
calcular ninguna función cinemática inversa. Haremos uso de esto cuando considere¬ 
mos el problema de control en capítulos posteriores. 


5.11 TRANSFORMACIÓN CARTESIANA DE VELOCIDADES Y FUERZAS ESTÁTICAS 


Podría ser conveniente pensar en términos de representaciones de 6 x 1 de la veloci¬ 
dad general de un cuerpo: 

v = í U 1 . (5.98) 


De igual forma podríamos considerar representaciones de 6 x 1 de vectores de fuerza 
generales, tales como 


T = 


F 

N 


(5.99) 


3 Considere un manipulador planar de dos vínculos extendido casi por completo, con el efector final en 
contacto con una superficie de reacción. En esta configuración, "pequeños” momentos de torsión de articu¬ 
lación podrían ejercer fuerzas arbitrariamente grandes. 
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en donde F es un vector de fuerza de 3 x 1 y N es un vector de momento de 3 x 1. Es 
natural entonces pensar en transformaciones de 6 x 6 que asignen estas cantidades de 
una trama a otra. Esto es exactamente lo que ya hemos hecho al considerar la propa¬ 
gación de velocidades y fuerzas de un vínculo a otro. Aquí escribimos las ecuaciones 
(5.45) y (5.47) en forma de operador matricial para transformar vectores de velocidad 
generales en la trama {A} a su descripción en la trama {Bj. 

Las dos tramas involucradas aquí están conectadas rígidamente, por lo que 6 i+l , 
que aparece en la ecuación (5.45), se hace cero al derivar la relación 


r b i> i 

V B 


r B n 

A R 

_ B D A p v- 

A K r BORG x 


1 

ÍU 

e 

_i 

B 

o>b _ 


O 

B D 

A R J 


i 

3 


(5.100) 


en donde se entiende que el producto cruz es el operador matricial 


Px 


0 

Px 

~Py 


~Px 

0 

Px 


Py 

-Px 

0 


(5.101) 


Ahora bien, la ecuación (5.100) relaciona las velocidades en una trama con las de otra, 
por lo que al operador de 6 x 6 lo llamaremos una transformación de velocidad; utili¬ 
zaremos el símbolo T. En este caso es una transformación de velocidad que asigna ve¬ 
locidades en |A¡ a velocidades en (B¡, por lo que usaremos la siguiente notación para 
expresar la ecuación (5.100) en forma compacta: 


1 v — B T A 
V B — a 1 v V A' 


(5.102) 


Podemos invertir la ecuación (5.100) para poder calcular la descripción de la velocidad 
en términos de ¡A), dadas las cantidades en ¡Bj: 


o 


i 

i_ 


" Ad 

B R 

A p v A r> 

r BORG x b K 


r b u i 

U B 

3 

¡u 

i_ 


O 

A D 

B R J 


B 

a> B _ 


(5.103) 


_ Aj B 
V A — B 1 u V B' 


(5.104) 


Observe que estas asignaciones de velocidades de trama a trama dependen de ^ T (o 
de su inversa) y, por lo tanto, deben interpretarse como resultados instantáneos, a me¬ 
nos que la relación entre las dos tramas sea estática. De manera similar, de las ecuacio¬ 
nes (5.80) y (5.81), escribimos la matriz de 6 x 6 que transforma vectores de fuerza 
generales en términos de ¡B) en su descripción en la trama {A}: 



A 

B 


R 


BORO 


b R 


0 


b r 


B Fb 

b N b 


(5.105) 


que puede escribirse en forma compacta así: 


A '27 _ A t B '27 

^ A ~ B 1 f 


(5.106) 


en donde 7) denota una transformación de fuerza-momento. 
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Las transformaciones de velocidad y de fuerza son similares a los jacobianos en 
cuanto a que relacionan velocidades y fuerzas en distintos sistemas de coordenadas. Al 
igual que con los jacobianos, tenemos que 


A t _ A rpT 

B 1 f ~ B 1 v ’ 


(5.107) 


como puede verificarse si se examinan las ecuaciones (5.105) y (5.103). 


EJEMPLO 5.8 

La figura 5.13 muestra un efector final sosteniendo una herramienta. En el punto en el 
que el efector final se une al manipulador está ubicada una muñeca con sensor de fuer¬ 
za. Éste es un dispositivo que puede medir las fuerzas y los momentos de torsión que 
se le aplican. 

Considere que la salida de este sensor es un vector de 6 x 1 llamado S T, compues¬ 
to de tres fuerzas y tres momentos de torsión expresados en la trama del sensor, ¡5). 
Nuestro verdadero interés está en conocer las fuerzas y momentos de torsión que se 
aplican en la punta de la herramienta, J T. Encuentre la transformación de 6 x 6 que 
transforma el vector de fuerza-momento de ¡5¡ a la trama herramienta, {7"}. La trans¬ 
formada que relaciona {Lj con ¡5), R T, es conocida. (Observe que ¡Sj aquí es la trama 
del sensor, no la trama estación). 

Ésta es simplemente una aplicación de la ecuación (5.106). En primer lugar, de 
s r T calculamos la inversa, ( T, que está compuesta de J R y de T P SORG - Entonces apli¬ 
camos la ecuación (5.106) para obtener 


en donde 


77 _ 1 r r ¿77 

^ T~s .f 


Tt = 


s/ 


s R 

T P SORG 



(5.108) 


(5.109) 
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EJERCICIOS 

5.1 [10] Repita el ejemplo 5.3, pero utilice el jacobiano escrito en la trama [0¡. ¿Los resul¬ 
tados son los mismos que los del ejemplo 5.3? 

5.2 [25] Encuentre el jacobiano del manipulador con tres grados de libertad del ejercicio 
3 del capítulo 3. Escríbalo en términos de una trama [4] ubicada en la punta de la ma¬ 
no y con la misma orientación que la trama [3]. 

5.3 [35] Encuentre el jacobiano del manipulador con tres grados de libertad del ejercicio 
3 del capítulo 3. Escríbalo en términos de la trama [4] ubicada en la punta de la mano 
y con la misma orientación que la trama [3]. Derive el jacobiano de tres maneras dis¬ 
tintas: propagación de velocidad de la base a la punta, propagación de fuerza estática 
de la punta a la base y diferenciación directa de las ecuaciones cinemáticas. 

5.4 [8] Demuestre que las singularidades en el dominio de la fuerza existen en las mismas 
configuraciones que las singularidades en el dominio de la posición. 

5.5 [39] Calcule el jacobiano del PUMA 560 en la trama [6]. 

5.6 [47] ¿Es cierto que cualquier mecanismo con tres articulaciones angulares y longitu¬ 
des de vínculo distintas de cero debe tener una región con puntos singulares dentro 
de su espacio de trabajo? 

5.7 [7] Bosqueje la figura de un mecanismo con tres grados de libertad, cuyo jacobiano de 
velocidad lineal sea la matriz de identidad de 3 x 3 sobre todas las configuraciones del 
manipulador. Describa la cinemática en una oración o dos. 

5.8 [18] Algunas veces los mecanismos generales tienen ciertas configuraciones, llamadas 
“puntos isotrópicos”, en donde las columnas del jacobiano se vuelven ortogonales y 
de igual magnitud [7]. Para el manipulador de dos vínculos del ejemplo 5.3, encuen¬ 
tre si existen puntos isotrópicos. Sugerencia: ¿hay un requerimiento sobre /j y / 9 ? 

5.9 [50] Encuentre las condiciones necesarias para que existan puntos isotrópicos en un 
manipulador general con seis grados de libertad. (Vea el ejercicio 5.8). 

5.10 [7] Para el manipulador de dos vínculos del ejemplo 5.2, proporcione la transforma¬ 
ción que asigne los momentos de torsión de articulación a un vector de fuerza de 
2x1, 3 F, en la mano. 

5.11 [14] Dada 


A 

B 


T = 


-0.866 -0.500 0.000 10.0" 
0.500 0.866 0.000 0.0 

0.000 0.000 1.000 5.0 

0 0 0 1 . 
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5.12 


5.13 


si el vector de velocidad en el origen de {A} es 

0.0 
2.0 
-3.0 
1.414 
1.414 
0.0 

Encuentre el vector de velocidad de 6 x 1 cuyo punto de referencia sea el origen de ¡5}. 
[15] Para el manipulador de tres vínculos del ejercicio 3.3, proporcione un conjunto 
de ángulos de articulación para los que el manipulador esté en una singularidad en la 
frontera del espacio de trabajo, y otro conjunto de ángulos para los cuales el manipu¬ 
lador esté en una singularidad dentro del espacio de trabajo. 

[9] Cierto manipulador de dos vínculos tiene el siguiente jacobiano: 


5.14 


5.15 


5.16 


5.17 


J 7(0) = 


~h s i ~ h s u -l. 


2 J 12 


. h c i + h c i2 h c u 

Ignorando la gravedad, ¿cuáles son los momentos de torsión de articulación requeri¬ 
dos para que el manipulador aplique un vector de fuerza estático °F = 10A fl ? 

[18] Si el parámetro de vínculo a 3 del PUMA 560 fuera cero, ocurriría una singulari¬ 
dad en la frontera del espacio de trabajo cuando 0 3 = —90.0°. Dé una expresión para 
el valor de d 3 en donde ocurra la singularidad y demuestre que, si a 3 fuera cero, el re¬ 
sultado sería d 3 = —90.0°. Sugerencia : en esta configuración pasa una línea recta a tra¬ 
vés de los ejes de articulación 2 y 3, y el punto en el que se intersecan los ejes 4, 5 y 6. 
[24] Proporcione el jacobiano de 3 x 3 que calcule la velocidad lineal de la punta de 
la herramienta a partir de las tres proporciones de articulación para el manipulador 
del ejemplo 3.4 en el capítulo 3. Proporcione el jacobiano en la trama [0]. 

[20] Un manipulador 3 R tiene una cinemática que corresponde exactamente al con¬ 
junto de ángulos de Euler Z-Y-Z (es decir, la cinemática directa se proporciona me¬ 
diante la ecuación (2.72) con a = 6 V ¡3 = 0 2 y y = 9 3 ). Proporcione el jacobiano que 
relaciona las velocidades de articulación con la velocidad angular del último vínculo. 
[31] Imagine que para un robot de 6 grados de libertad (6-DÓF) general tenemos dis¬ 
ponibles °Z ¡ y °P iorg para todas las i: esto es, conocemos los valores para los vectores 
Z unitarios de cadá trama de vínculo en términos de la trama base y conocemos las 
ubicaciones de los orígenes de todas las tramas de los vínculos en términos de la tra¬ 
ma base. Digamos también que estamos interesados en la velocidad del punto de la 
herramienta (fijo respecto al vínculo n) y que conocemos también Q Pherramienta- Ahora, 
para una articulación angular, la velocidad de la punta de la herramienta debida a la 
velocidad de la articulación i se da mediante 


Oj. _ Q 0y (0 p — 0 P. 

i i i ' herramienta 10 




(5.110) 


y la velocidad angular del vínculo n debida a la velocidad de esta articulación se da 
mediante 


°co i =Ó i °Z i . (5.111) 

La velocidad lineal y angular total de la herramienta se da mediante la suma de °v / y 
°(o ¡ respectivamente. Proporcione ecuaciones análogas a (5.110) y (5.111) para el caso 
de la articulación i prismática, y escriba la matriz jacobiana de 6 x 6 de un manipula¬ 
dor 6-DOF arbitrario en términos de Z , P y °P herramlenta - 
5.18 [18] El comportamiento cinemático de un robot 3 R se da mediante 



c l c 23 

~ c l s 23 

s i 

^l c l + ^2 c l c 2 

0 T = 

■ s 'l c 23 

~ s l s 23 
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h s 2 
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Encuentre °/(@) que, al multiplicarse por el vector de velocidad de articulación, da la 
velocidad lineal del origen de la trama {3} en forma relativa a la trama {Oj. 

5-19 [15] La posición del origen del vínculo 2 para un manipulador RP se da mediante 


a lCl — d 2 s l 

Ujíj + d 2 Ci 



0 


Proporcione el jacobiano de 2 x 2 que relacione las dos velocidades de articulación 
con la velocidad lineal del origen de la trama {2}. Proporcione un valor de 0 en el que 
el dispositivo esté en una singularidad. 

5.20 [20] Explique lo que podría significar el enunciado: “Un manipulador de n grados de 
libertad (n-DOF) en una singularidad puede tratarse como un manipulador redun¬ 
dante en un espacio con una dimensión de n — 1”. 

EJERCICIO DE PROGRAMACIÓN (PARTE 5) 

1. Dos tramas [A] y [B] no se están moviendo en forma relativa entre sí; esto es, 
B T es constante. En el caso planar definimos la velocidad de la trama [A] como 



A 


Escriba una rutina que, dadas B T y A v A , calcule B v B . Sugerencia: ésta es la aná¬ 
loga planar de (5.100). Use un encabezado de procedimiento como el siguiente 
(o su equivalente en C): 

Procedure Veltrans (VAR brela: trama; VAR vrela, vrelb: vec3); 

en donde “vrela” es la velocidad relativa a la trama [A], o A v A , y “vrelb” es la 
salida de la rutina (la velocidad relativa a la trama (Bj), o B v B . 

2. Determine el jacobiano de 3 x 3 del manipulador planar de tres vínculos (del 
ejemplo 3.3). Para poder derivar el jacobiano deberá utilizar un análisis de pro¬ 
pagación de velocidad (como en el ejemplo 5.2) o un análisis de fuerza estática 
(como en el ejemplo 5.6). Entregue su trabajo mostrando cómo obtuvo el jaco¬ 
biano. 

Escriba una rutina para calcular el jacobiano en la trama [3]; esto es, 
-1/(0). como una función de los ángulos de articulación. Observe que la trama 
[3] es la trama de vínculo estándar con origen en el eje de la articulación 3. Use 
un encabezado de procedimiento similar al siguiente (o su equivalente en C): 

Procedure jacobiano (VAR theta: vec3; Var Jac: mat33); 

Los datos del manipulador son l 2 = l 2 = 0.5 metros. 

3. Una trama herramienta y una trama estación son definidas de la siguiente mane¬ 
ra por el usuario para cierta tarea (las unidades están en metros y grados): 


= [x y 6] = [0.10.2 30.0], 
b s T = [.v y <9] = [0.0 0.0 0.0], 


En cierto instante, la punta de la herramienta se encuentra en la posición 


s t T = [x y 0] = [0.6 - 0.3 45.0], 
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En el mismo instante se miden las proporciones de articulación (en grados/se¬ 
gundo): 

0 = [% é 2 Ó 3 \ = [20.0 - 10.0 12.0], 

Calcule la velocidad lineal y angular de la punta de la herramienta referida a su 
propia trama, T v r Si hay más que una posible respuesta, calcúlelas todas. 

EJERCICIO MATLAB 5 

Este ejercicio se enfoca en la matriz jacobiana y la determinante, el control simulado con 
velocidad resuelta y la estática inversa para el robot planar 3-DOF, 3R. (Vea las figuras 3.6 
y 3.7; los parámetros de DH se proporcionan en la figura 3.8). 

El método de control con velocidad resuelta [9] se basa en la ecuación de velocidad 
del manipulador k X— k J& , en donde k J es la matriz jacobiana, © es el vector de veloci¬ 
dades relativas de articulación, k Xes el vector de velocidades cartesianas comandadas (tan¬ 
to de traslación como de rotación), y A: es la trama de expresión para la matriz jacobiana y 
las velocidades cartesianas. Esta figura muestra un diagrama de bloques para simular el al¬ 
goritmo de control con velocidad resuelta: 



Diagrama de bloque del algoritmo con velocidad resuelta 


Como se puede ver en la figura, el algoritmo de velocidad resuelta calcula las veloci¬ 
dades de articulación comandadas © c que se requieren para proporcionar las velocidades 
cartesianas comandadas X' este diagrama debe calcularse en cada intervalo simulado. La 
matriz jacobiana cambia con la configuración © A . Para fines de simulación, suponga que 
los ángulos de articulación comandados 0 C son siempre idénticos a los ángulos de articu¬ 
lación realmente alcanzados, © A (un resultado que raras veces es verdadero en el mundo 
real). Para el robot planar 3-DOF, 3R asignado, las ecuaciones de velocidad k X= k J& pa¬ 
ra k = 0 son 

-L l s l -L 2 s 12 -L 3 s 123 ~L 2 s u ~ L 3 s 123 —L 3 s 123 Í9 1 

0 L 1 c 1 + L 2 c 12 + L 3 c 123 L 2 c 12 + L 3 c 123 L 3 c 123 | Ó 2 , 

1 1 1 J k 

en donde í 123 = sen(0j + 0 2 + 0 3 ), = cos^ + 0 2 + 0 3 ), y así sucesivamente. Observe que 

°X proporciona las velocidades cartesianas del origen de la trama de la mano (en el centro 
de las pinzas en la figura 3.6) respecto al origen de la trama base ¡0), expresada en coorde¬ 
nadas de {0j. 

Ahora bien, la mayoría de los robots industriales no pueden comandar 0 c directa¬ 
mente, por lo que primero debemos integrar estas velocidades relativas de articulación co¬ 
mandadas con los ángulos de articulación comandados 0 C , que pueden ordenarse al robot 
en cada intervalo de tiempo. En la práctica, el esquema de integración más simple posible 
funciona bien, suponiendo un intervalo de control At pequeño: © nuevo = © anlerloI . + 0 At. En 
su simulación de velocidad resuelta de MATLAB suponga que el robot virtual puede lograr 
perfectamente el © nuevo comandado. (En los capítulos 6 y 9 presentaremos material de di¬ 
námica y control para el que no tendremos que hacer esta suposición simplificadora.) Ase- 
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gúrese de actualizar la matriz jacobiana con la nueva configuración 0 nuevo antes de comple¬ 
tar los cálculos de velocidad resuelta para el siguiente intervalo de tiempo. 

Desarrolle un programa en MATLAB para calcular la matriz jacobiana y para simu¬ 
lar el control con velocidad resuelta para el robot 3R planar. Dadas las longitudes del robot 
L 1 = 4, L 0 = 3 y L 3 = 2(m); los ángulos de articulación iniciales & = { 6 1 0 2 6 3 } T = ¡10° 20° 
30°} r y las proporciones cartesianas comandadas constantes °{X) = { x y co,} T = {0.2 —0.3 
—0.2} r (m/s, m/s, rad/s), simule para 5 segundos exactamente, usando intervalos de exacta¬ 
mente di = 0.1 seg. En el mismo ciclo del programa calcule el problema de estática inversa; 
es decir, los momentos de torsión de articulación T = {t : x 2 x 3 } 7 (Nm), dada la llave de tor¬ 
sión cartesiana constante comandada °{W) = [f x f m,} 7 ={12 3} r (N, N, Nm). Además, 
en el mismo ciclo, anime el robot en la pantalla durante cada intervalo de tiempo, de mane¬ 
ra que pueda observar el movimiento simulado para verificar que sea correcto. 

a) Para los números específicos asignados, presente cinco diagramas (cada uno en un 
gráfico separado, por favor): 

1. Las tres proporciones de articulación activas 0 = [9 1 0 2 6 3 } T contra el tiempo. 

2. Los tres ángulos de articulación activos 0 = [6 l 0-, 0 2 \ r contra el tiempo. 

3. Los tres componentes cartesianos de ° H T, X = [x y <¡>} T (rad está bien para <¡>, de 
manera que pueda ponerse en el mismo diagrama) contra el tiempo. 

4. El determinante de la matriz jacobiana l/l contra el tiempo; comente la cercanía 
de singularidades durante el movimiento simulado con velocidad resuelta. 

5. Los tres momentos de torsión activos T = {x 1 x 2 x,| 7 contra el tiempo. 

Etiquete cuidadosamente (a mano está bien) cada componente en cada trazo; 
también etiquete los ejes con nombres y unidades. 

b) Compruebe los resultados de su matriz jacobiana para los conjuntos inicial y final 
de ángulos de articulación mediante la Caja de Herramientas de Robótica 
MATLAB de Corke. Pruebe la función jacobOQ. Precaución: Las funciones jaco- 
bianas de la caja de herramientas son para el movimiento de {3} respecto a {0}, no 
para [H] respecto a {0}, como en la asignación del problema. La anterior función 
da el resultado jacobiano en coordenadas de {0¡; jacobn() da los resultados en 
coordenadas de {3}. 
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6.1 INTRODUCCIÓN 

Hasta ahora, nuestro estudio de los manipuladores se ha enfocado solamente en las con¬ 
sideraciones cinemáticas. Hemos estudiado posiciones estáticas, fuerzas estáticas y velo¬ 
cidades; pero no hemos considerado las fuerzas requeridas para producir movimiento. 
En este capítulo consideraremos las ecuaciones de movimiento para un manipulador: la 
manera en que se produce el movimiento del manipulador debido a los momentos de 
torsión aplicados por los actuadores, o a fuerzas externas aplicadas al manipulador. 

La dinámica de mecanismos es un campo sobre el cual se han escrito muchos li¬ 
bros y podríamos pasar años estudiando ese campo. Obviamente no podemos cubrir el 
material con todo el detalle que merece; no obstante, ciertas formulaciones del proble¬ 
ma de la dinámica parecen especialmente adecuadas para aplicarse a los manipulado¬ 
res; en especial, los métodos que hacen uso de la naturaleza de cadena serial de los 
manipuladores son candidatos naturales para nuestro estudio. 

Hay dos problemas que deseamos resolver que están relacionados con la dinámi¬ 
ca de un manipulador. En el primer problema se nos proporciona un punto de trayec¬ 
toria, 0, 0 y 0, y deseamos encontrar el vector requerido de momentos de torsión de 
articulación, r. Esta formulación de la dinámica es útil para el problema de controlar el 
manipulador (capítulo 10). El segundo problema es calcular cómo se moverá el meca¬ 
nismo bajo la aplicación de un conjunto de momentos de torsión de articulación. Esto 
es, dado un vector de momento de torsión r, calcular el movimiento resultante del ma¬ 
nipulador, 0, 0 y 0. Esto es útil para simular el manipulador. 
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6.2 ACELERACIÓN DE UN CUERPO RÍGIDO 


Ahora extenderemos nuestro análisis del movimiento de cuerpos rígidos al caso de las 
aceleraciones. En cualquier instante, los vectores de velocidad lineal y angular tienen 
derivadas llamadas aceleraciones lineal y angular, respectivamente. Esto es, 


V n = — V n = lím 


Q 


dt 


A t- 


l V Q (t + At)- B V Q (t) 
A t 


( 6 . 1 ) 


= 


dt 


= lím 

B Ar->o 


£2 B (t + At) — & B (t) 
A t 


( 6 . 2 ) 


Al igual que con las velocidades, cuando se sabe que la trama de referencia de la diferen¬ 
ciación es cierta trama de referencia universal, por ejemplo ¡f/¡, utilizamos la notación 


v Á = u V. 


AORG 


(6.3) 


y 


¿o A = u ñ A . 


(6.4) 


Aceleración lineal 

Empezaremos reformulando la ecuación (5.12) un resultado importante del capítulo 5, 
que describe la velocidad de un vector B Q visto desde la trama ¡A) cuando los orígenes 
son coincidentes: 


a Vq = a b R b V q + a Q b x a b R b Q. (6.5) 

El lado izquierdo de esta ecuación describe cómo cambia A Q en el tiempo. Debido a 
que los orígenes son coincidentes, podríamos reescribir la ecuación (6.5) como 

j t ( A R B Q) = A R B V Q + A n B x A B R B Q. ( 6 . 6 ) 

Esta forma de la ecuación será útil cuando se derive la ecuación de aceleración corres¬ 
pondiente. 

Al diferenciar la ecuación (6.5) podemos derivar expresiones para la aceleración 
de B Q visto desde ¡A) cuando coinciden los orígenes de ¡A) y ¡5): 

% = ^( a R b V q ) + a Ú b x a R b Q + a í2 b x j t ( A R b Q). (6.7) 

Ahora aplicamos la ecuación (6.6) dos veces; una al primer término y otra al último tér¬ 
mino. El lado derecho de la ecuación (6.7) se convierte en: 

a R b V q + a ^ b x a R b V q + a Ü b x a R b Q (6 

+ A n B x( A R B V Q + A n B x A R B Q). 

Si combinamos dos términos obtenemos 


A R B V Q + 2 A Í2 B x a R b V q + a Ú b x A R B Q + A n B x( A C2 B x A R B Q). (69) 
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Por último, para generalizar en el caso en que los orígenes no sean coincidentes, agre¬ 
gamos un término que proporciona la aceleración lineal del origen de { B ¡, lo que pro¬ 
duce la siguiente fórmula general para el lado derecho de la ecuación: 

A Vborg + b rB Vq+ 2 A V B x a R b V q + a Q b x a R b Q ( 6 . 10 ) 

+ a Q b x ( a Q b x a R b Q). 

Un caso particular que vale la pena mencionar es cuando B Q es constante, o 

b V q = b V q = 0. (6.11) 

En este caso, la ecuación (6.10) se simplifica a 

% = A V borg + A tt B x ( a £2 b x a R b Q) + a ¿2 b x a R b Q. (6.12) 

Utilizaremos este resultado para calcular la aceleración lineal de los vínculos de un ma¬ 
nipulador con articulaciones giratorias. Cuando exista una articulación prismática se 
utilizará la forma más general de la ecuación (6.10). 

Aceleración angular 

Considere el caso en el que ¡5¡ está girando de manera relativa a ¡A) con ^£2 B , y |C¡ es¬ 
tá girando de manera relativa a ¡5¡ con B Q. C Para calcular A Q. C sumamos los vectores 
en la trama ¡A): 

A n c = A £2 B + A R B n c . (6.13) 

Al diferenciar obtenemos 

A Ü C = A Ú B + ^( A R B Í2 C ). (6.14) 

Ahora, si aplicamos la ecuación (6.6) al último término de la ecuación (6.14), obtenemos 

A ti c = a Ü b + a R B tl c + a Q b x a R b Q c . (6.15) 

Utilizaremos este resultado para calcular la aceleración angular de los vínculos de un 
manipulador. 

6.3 DISTRIBUCIÓN DE LA MASA 

A menudo hablamos de la masa de un cuerpo rígido en sistemas con un solo grado de 
libertad; en el caso del movimiento giratorio sobre un solo eje es muy común el término 
momento de inercia. Para un cuerpo rígido que tiene la libertad de moverse en tres di¬ 
mensiones, hay un número infinito de posibles ejes de rotación. En el caso de la rotación 
sobre un eje arbitrario necesitamos una forma completa de caracterizar la distribución de 
la masa de un cuerpo rígido. Aquí presentaremos el tensor de inercia que, para nues¬ 
tros propósitos, puede definirse como una generalización del momento escalar de iner¬ 
cia de un objeto. 

Ahora definiremos un conjunto de cantidades que proporcionan información so¬ 
bre la distribución de la masa de un cuerpo rígido con respecto a una trama de referen¬ 
cia. La figura 6.1 muestra un cuerpo rígido con una trama adscrita. Pueden definirse los 
tensores de inercia en relación con cualquier trama, pero siempre consideraremos el 
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FIGURA 6.1: El tensor de inercia de un objeto describe la distribución de la masa de ese 
objeto. Aquí, el vector A P posiciona el elemento de volumen diferencial, dv. 


caso de un tensor de inercia definido para una trama unida al cuerpo rígido. Cuando 
sea importante indicaremos, con un superíndice a la izquierda, la trama de referencia 
de un tensor de inercia dado. El tensor de inercia relativo a la trama {A} se expresa en 


'/ = 


^ vy 

L-'« 


3 x 

3: 

-I 

-I 1 

xy 

xz 

I 

-1 

yy 

yz. 

-I 

I 

yz 

zz J 


(6.16) 


en donde los elementos escalares están dados por 




lyy 


/ = 


4 , 


/ = 


4z = 


-SSL 
-SSL 
ÍÍL 
-SSL 
ÍÍL 


(y + z )pdv, 


(x 2 + z 2 )pdv, 


(x 2 + y 2 )pdv, 


xypdv, 


xzpdv, 


///,”*’■ 


(6.17) 


aquí, el cuerpo rígido está compuesto de elementos de volumen diferencial, dv, que 
contienen material de densidad p. Cada elemento de volumen está ubicado con un vec¬ 
tor, A P — [x y z] r , como se muestra en la figura 6.1. 

Los elementos I xx , I e /__ se llaman momentos de inercia de masas. Observe que, 
en cada caso estamos integrando los elementos de la masa, pdv, multiplicados por los 
cuadrados de las distancias perpendiculares al eje correspondiente. Los elementos con 
índices mezclados se llaman productos de inercia de masas. Este conjunto de seis 
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cantidades independientes dependerá, para un cuerpo dado, de la posición y orienta¬ 
ción de la trama en la que estén definidas. Si podemos elegir la orientación de la trama 
de referencia, es posible hacer que los productos de inercia sean cero. Cuando se ali¬ 
nean así los ejes de la trama de referencia se llaman ejes principales, y los momentos 
de masas correspondientes son los momentos principales de inercia. 


EJEMPLO 6.1 


Encuentre el tensor de inercia para el cuerpo rectangular de densidad p uniforme con 
respecto al sistema de coordenadas que se muestra en la figura 6.2. 

Primero calculamos I . Usando el elemento de volumen dv — dx dy dz, obtenemos 


nh ni neo 

/ / / ( y 2 + ¿ 2 )p dx ¿y dz 

Jo Jo Jo 


dXX 


h A 


n 

l 


(y 2 + z 2 )mpdy dz 


h / 1 3 


— + z l 1 copdz 


hfteo l'r’lw 


= ~(l Z + h ¿ ), 


(6.18) 


en donde m es la masa total del cuerpo. Si permutamos los términos podemos obtener 
/ e ¡ 7Z por inspección: 


Iyy = ^ + h 2 ) (6.19) 

y 

f zz = y(/ 2 W). (6.20) 


z 



FIGURA 6.2: Un cuerpo de densidad uniforme. 
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A continuación calculamos / : 


rh pl peo 

Jo Jo Jo 

r h r 1 co 2 

-Jo Jo ~2 

-f 


1 \ y 


xyp dx dy dz 
yp dy dz 


m 

= —col. 
4 


Si permutamos los términos obtenemos 


m 

'xz = 


m 

h* = 4 "• 


Por lo tanto, el tensor de inercia para este objeto es 

-%col 


r j d 2 


*/ = 


h 2 ) 


■fal 2(co 2 + h 2 ) 


rhcO 


rh/ 


-’fhco 

-fhl 

f(/ 2 + « 2 ) J 


( 6 . 21 ) 


( 6 . 22 ) 


(6.23) 


(6.24) 


Como se indicó, el tensor de inercia es una función de la ubicación y la orienta¬ 
ción de la trama de referencia. El teorema de ejes paralelos (un resultado bien conoci¬ 
do) es una manera de calcular cómo cambia el tensor de inercia bajo las traslaciones del 
sistema de coordenadas de referencia. El teorema de ejes paralelos relaciona el tensor 
de inercia en una trama cuyo origen está en el centro de masa, con el tensor de inercia 
con respecto a otra trama de referencia. Cuando ¡C¡ se encuentra en el centro de ma¬ 
sas del cuerpo y ¡A¡ es una trama trasladada arbitrariamente, el teorema puede definir¬ 
se [1] como 

^ = % + ™(* 2 + y 2 ), 

A 4y = C 4 y-mx c y c , (6.25) 

en donde P. = [jc , y , z ] r ubica el centro de masas relativo a ¡A); los momentos y pro¬ 
ductos de inercia restantes se calculan a partir de permutaciones de x, y y z en la ecua¬ 
ción (6.25). El teorema puede definirse en forma vectorial-matricial como 

A I = C I + m[Pj P C I 3 - P c P T c l (6.26) 

en donde / 3 es la matriz de identidad de 3 x 3. 


EJEMPLO 6.2 

Encuentre el tensor de inercia para el mismo cuerpo sólido descrito en el ejemplo 6.1, 
cuando está descrito en un sistema de coordenadas con el origen en el centro de masas 
del cuerpo. 
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Podemos aplicar el teorema de ejes paralelos (6.25), en donde 




Después encontramos 


/ « = i2 ( ^ + n. 

hy = O- 


(6.27) 


Los demás elementos se encuentran por simetría. El tensor de inercia resultante escri¬ 
to en la trama que está en el centro de masas es 


/ = 


12 


c h ¿ + ñ 

o 

0 


12 


(co ¿ 


h * 1 2 3 4 ) 


0 
0 

m //2 i , >2\ 

12 C/ + & ) J 


(6.28) 


El resultado es diagonal, por lo que la trama ¡C) debe representar los ejes principales 
de este cuerpo. 


Algunos hechos adicionales sobre los tensores de inercia son: 

1. Si dos ejes de la trama de referencia forman un plano de simetría para la distri¬ 
bución de la masa del cuerpo, los productos de inercia que tengan como índice la 
coordenada que sea normal al plano de simetría serán cero. 

2. Los momentos de inercia siempre deben ser positivos. Los productos de inercia 
pueden tener cualquier signo. 

3. La suma de los tres momentos de inercia está invariante bajo cambios de orien¬ 
tación en la trama de referencia. 

4. Los valores propios de un tensor de inercia son los momentos principales para el 
cuerpo. Los vectores propios asociados son los ejes principales. 

La mayoría de los manipuladores tienen vínculos cuya geometría y composición 
son algo complejas, de manera que es difícil en la práctica aplicar la ecuación (6.17). 
Una opción pragmática es medir, en lugar de calcular el momento de inercia de cada 
vínculo, utilizando un dispositivo de medición (por ejemplo, un péndulo de inercia). 

6.4 ECUACIÓN DE NEWTON, ECUACIÓN DE EULER 

Vamos a considerar cada vínculo de un manipulador como un cuerpo rígido. Si cono¬ 
cemos la ubicación del centro de masas y el tensor de inercia del vínculo, entonces su 
distribución de masa está completamente caracterizada. Para mover los vínculos debe¬ 
mos acelerarlos y desacelerarlos. Las fuerzas requeridas para dichos movimientos son 
una función de la aceleración deseada y de la distribución de la masa de los vínculos. 
La ecuación de Newton, junto con su análoga de rotación, la ecuación de Euler, descri¬ 
be la manera en que se relacionan las fuerzas, inercias y aceleraciones. 
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FIGURA 6.3: Una fuerza F que actúa en el centro de masas de un cuerpo hace que éste 
se acelere a v. 


Ecuación de Newton 

La figura 6.3 muestra un cuerpo rígido cuyo centro de masas tiene una aceleración re¬ 
presentada por v c En dicha situación, la fuerza F que actúa en el centro de masas y pro¬ 
duce esta aceleración se da mediante la ecuación de Newton: 

F = mv c , (6.29) 

en donde >n es la masa total del cuerpo. 

Ecuación de Euler 

La figura 6.4 muestra un cuerpo rígido que gira con una velocidad angular w y una ace¬ 
leración angular ib. En dicha situación, el momento N que debe estar actuando en el 
cuerpo para producir este movimiento, se obtiene mediante la ecuación de Euler: 

N = c Ico + a) x c lea, (6.30) 

en donde C I es el tensor de inercia del cuerpo escrito en una trama ¡Cj, cuyo origen se 
encuentra en el centro de masas. 



FIGURA 6.4: Un momento N que actúa sobre un cuerpo, y éste gira con una velocidad 
a> y acelera a ib. 
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6.5 FORMULACIÓN DINÁMICA ITERATIVA DE NEWTON-EULER 

Ahora consideraremos el problema de calcular los momentos de torsión que corres¬ 
ponden a una trayectoria dada de un manipulador. Vamos a suponer que conocemos la 
posición, velocidad y aceleración de las articulaciones (0, 0, 0). Con estos datos, y cono¬ 
ciendo la información de cinemática y distribución de masa del robot, podemos calcular 
los momentos de torsión de las articulaciones requeridos para producir este movimiento. 
El algoritmo que se presenta está basado en el método publicado por Luh, Walter y 
Paul en [2]. 


Iteraciones salientes para calcular velocidades y aceleraciones 

Para calcular las fuerzas inerciales que actúan en los vínculos es necesario calcular la 
velocidad de rotación y la aceleración lineal y rotacional del centro de masas de cada 
vínculo del manipulador en cualquier instante dado. Estos cálculos deben realizarse en 
forma iterativa, empezando con el vínculo 1 y avanzando sucesivamente, vínculo por 
vínculo hacia fuera hasta el vínculo n. 

En el capítulo 5 hablamos sobre la “propagación” de velocidad de rotación de un 
vínculo a otro, y se da (para la articulación giratoria i + 1) mediante 

,+ V+i = \ +l R '«,■ + 0 i+1 %. (6.31) 

De (6.15) obtenemos la ecuación para transformar la aceleración angular de un víncu¬ 
lo al siguiente: 


í+i. 


= ¡ +1 *'¿t + ? ír1 <oí x 0¿+i ,+L z ¡+ 1 + 0 , +1 ,+L z¡+i- 


. ! + l ¡3 i 


í+lr 


i+ 1- 


(6.32) 


Cuando la articulación i + 1 es prismática, esto se simplifica a 


¿+l • 


°i +1 


= Í+l R‘(0:. 


(6.33) 


La aceleración lineal del origen de cada trama de vínculo se obtiene mediante la apli¬ 
cación de la ecuación (6.12): 

i+1 v i+l = MrVoí x «■ P ¡+1 + i co i x C*,,. x -> f+1 ) + (6.34) 

Para la articulación i + 1 prismática, la ecuación (6.34) se convierte [de la ecuación 
(6.10)] en 

Í+ \+l = X ‘p ¡+1 + ‘a, x Qto. x ‘p i+1 ) + %) 

+ 2 i+l co ¡+1 x d i+1 i+1 Z i+l + d i+l %. (6.35) 

Asimismo, necesitaremos la aceleración lineal del centro de masas de cada vínculo, que 
también puede encontrarse aplicando la ecuación (6.12): 


l v c , = 1 cú¡ x ' P c + ‘ají x ( l u¡¿ + ' P c ) + l i)¡, (6.36) 

Aquí imaginamos una trama [C ; ¡ unida a cada vínculo, con su origen ubicado en el cen¬ 
tro de masas del vínculo y con la misma orientación que la trama del vínculo, {/}. La 
ecuación (6.36) no implica el movimiento de la articulación, por lo cual es válida para 
la articulación i + 1, sin importar que sea angular o prismática. 

Observe que la aplicación de las ecuaciones al vínculo 1 es especialmente simple, 
ya que 0 a> 0 = °tú 0 = 0. 
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La fuerza y el momento de torsión que actúan sobre un vínculo 

Después de calcular las aceleraciones lineal y angular del centro de masas de cada 
vínculo, podemos aplicar las ecuaciones de Newton-Euler (sección 6.4) para calcular la 
fuerza y el momento de torsión inerciales que actúan en el centro de masas de cada 
vínculo. Por lo tanto tenemos que 


F i =mv c¡ , 

N¡ = C ‘ I¿o ¡ + u>¡ x c¡ Ico ¡, 


(6.37) 


en donde {Cjj tiene su origen en el centro de masas del vínculo y la misma orientación 
que la trama del vínculo, {/}. 

Iteraciones entrantes para calcular fuerzas y momentos de torsión 

Si ya calculamos las fuerzas y momentos de torsión que actúan en cada vínculo, ahora 
necesitamos calcular los momentos de torsión de articulación que producirán estas 
fuerzas y los momentos de torsión netos que se aplican a cada vínculo. 

Podemos hacer esto escribiendo una ecuación de balance de fuerza y balance de 
momento, basada en el diagrama de cuerpo libre de un vínculo común. (Vea la figura 
6.5). Sobre cada vínculo se ejercen fuerzas y momentos de torsión provenientes de los 
vínculos adyacentes, además de que experimenta una fuerza y un momento de torsión 
inerciales. En el capítulo 5 definimos símbolos especiales para la fuerza y el momento 
de torsión ejercidos por un vínculo adyacente, los cuales repetiremos aquí: 
f i — fuerza ejercida en el vínculo i por el vínculo i — 1, 
n¡ — momento de torsión ejercido en el vínculo i por el vínculo i — 1. 

Al sumar las fuerzas que actúan sobre el vínculo i llegamos a la relación de balan¬ 
ceo de fuerzas: 



(6.38) 


Al sumar los momentos de torsión sobre el centro de masas e igualarlos a cero, 
llegamos a la ecuación de balanceo de momentos de torsión: 



r 



Ti 


FIGURA 6.5: El balanceo de fuerzas, incluyendo las fuerzas inerciales, para el vínculo 
de un manipulador. 
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Si utilizamos el resultado de la relación de balanceo de fuerzas (6.38) y agrega¬ 
mos unas cuantas matrices de rotación, podemos escribir la ecuación (6.39) como 


' N; = f ». 


' J ? '+1 


I+l 


R l+L n 


i+l 


‘P Ci X X ; /? i+1 / i+ i. 


(6.40) 


Finalmente, podemos reordenar las ecuaciones de fuerza y momento de torsión 
para que aparezcan como relaciones iterativas desde el vínculo adyacente de mayor nu¬ 
meración hasta el de menor numeración: 


‘fi= Í i+1 RÍ+1 fi + l + ÍF i’ 
Í n .= Í N :- LÍ » Í+1 


+ \ +1 R ,+i «i+i + 'P c¡ x l F t + l P i+í X ;. + | R i+1 f i+1 . 


(6.41) 

(6.42) 


Estas ecuaciones se evalúan vínculo por vínculo, empezando por n y trabajando 
hacia la base del robot. Estas iteraciones entrantes de fuerza son análogas a las iteracio¬ 
nes de fuerza estáticas presentadas en el capítulo 5, excepto que ahora se toman en 
cuenta las fuerzas y momentos de torsión inerciales en cada vínculo. 

Como en el caso estático, los momentos de torsión de articulación requeridos 
pueden obtenerse tomando el componente Z del momento de torsión aplicado por un 
vínculo sobre su vínculo adyacente: 


r 


i n T ' Z,. 


(6.43) 


Para la articulación i prismática utilizamos 


r¡ = ‘f: 

i j i 


T i . 


(6.44) 


en donde hemos usado el símbolo r para la fuerza de un actuador lineal. 

Observe que, para un robot que se mueve en el espacio libre, N+1 f N+1 y N+1 n N+1 
se hacen iguales a cero, por lo que la primera aplicación de las ecuaciones para el víncu¬ 
lo n es bastante simple. Si el robot está en contacto con el entorno, las fuerzas y mo¬ 
mentos de torsión debidos a este contacto pueden incluirse en el balance de fuerzas 
haciendo que N+1 f N+1 y N+l n N x sean distintos de cero. 

El algoritmo iterativo de dinámica Newton-Euler 

El algoritmo completo para calcular momentos de torsión de articulación a partir del 
movimiento de éstas, se compone de dos partes. En primer lugar, las velocidades y ace¬ 
leraciones de los vínculos se calculan en forma iterativa desde el vínculo 1, hacia el 
vínculo n, y se aplican las ecuaciones de Newton-Euler en cada caso. En segundo lugar, 
las fuerzas y los momentos de torsión de interacción y los momentos de torsión del ac¬ 
tuador de una articulación se calculan en forma recursiva, desde el vínculo n hasta el 
vínculo 1. A continuación, se muestra un resumen de las ecuaciones para el caso en que 
todas las articulaciones son giratorias: 
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Iteraciones salientes: i: 0 —> 5 


i+1 ®i+t = 

\ +1 R i co i +é i+l i+1 Z i+í , 

(6.45) 

II 

+ 

¿3~ 

+ 

■ +Í R ‘®f + ; +1 *'«/ x é/+t i+l z i+ i + 

(6.46) 

II 

+ 

•¿~ 

+ 

\ +l R(!wi x i P i+l + i co¡ x ( ¡ « ; x , > ¡+1 ) + i ¿ i ). 

(6.47) 

i+1 v c = 

L i +1 

í+1 ¿m x i+lp c¡+1 



+ Í+ Vi x ( i+1 « ; . +1 X Í+1 P C;+1 ) + !+1¿ ;+l> 

(6.48) 

ii 

+ 

+ 

m i +1 ¿+1¿ c,. +1 - 

(6.49) 

ii 

+ 

+ 

c ‘+u m + i+i co i+1 x c «/,. +1 í+ y. +1 . 

(6.50) 

Iteraciones entrantes: i 

:6->l 



i fi = i i+1 R i+1 fi + i + ‘ F i’ 

(6.51) 


Í n i = i N i + i . +l R i+1 n i+1 + i P c¡ ^ i F i 



+ ip ¡+i x \ +l R i+x f i+ \. 

(6.52) 


r ; = ¡ n T 'Z,. 

(6.53) 


Inclusión de fuerzas de gravedad en el algoritmo de dinámica 

El efecto de carga de la gravedad sobre los vínculos puede incluirse muy fácilmente ha¬ 
ciendo que °v 0 = G, en donde G tiene la magnitud del vector de gravedad pero apunta 
en la dirección opuesta. Esto es equivalente a decir que la base del robot está aceleran¬ 
do hacia arriba con una aceleración de 1 g. Esta aceleración ficticia hacia arriba produ¬ 
ce exactamente el mismo efecto en los vínculos que tendría la gravedad. Así se calcula 
el efecto de la gravedad sin necesidad de incurrir en un gasto computacional adicional. 

6.6 COMPARACIÓN ENTRE FORMA ITERATIVA Y FORMA CERRADA 

Las ecuaciones (6.46) a (6.53) proporcionan un esquema computacional con el que, da¬ 
das las posiciones de articulaciones, velocidades y aceleraciones, podemos calcular los 
momentos de torsión de articulación requeridos. Al igual que con las ecuaciones que 
desarrollamos para calcular el jacobiano en el capítulo 5, estas relaciones pueden usar¬ 
se de dos formas: como un algoritmo computacional numérico o como un algoritmo 
usado analíticamente para desarrollar ecuaciones simbólicas. 

Es atractivo usar las ecuaciones como un algoritmo computacional numérico, ya 
que éstas se aplican a cualquier robot. Una vez que se especifican los tensores de iner¬ 
cia, las masas de los vínculos, los vectores P a y las matrices ' +l R para un manipulador 
específico, las ecuaciones pueden aplicarse directamente para calcular los momentos de 
torsión de articulación correspondientes a cualquier movimiento. 

No obstante, es conveniente tener una comprensión más detallada de la estructu¬ 
ra de las ecuaciones; por ejemplo, ¿cuál es la forma de los términos de gravedad? ¿Có¬ 
mo se compara la magnitud de los efectos de la gravedad con la magnitud de los efectos 
inerciales? Para investigar éstas y otras preguntas, a menudo es conveniente escribir 
ecuaciones dinámicas de forma cerrada. Estas ecuaciones pueden derivarse aplicando 
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las ecuaciones recursivas de Newton-Euler simbólicamente a ©, © y ©; lo cual es aná¬ 
logo a lo que hicimos en el capítulo 5 para derivar la forma simbólica del jacobiano. 


6.7 UN EJEMPLO DE ECUACIONES DINÁMICAS DE FORMA CERRADA 


Ahora calcularemos las ecuaciones dinámicas de forma cerrada para el manipulador 
planar de dos vínculos que se muestra en la figura 6.6. Por sencillez supondremos que 
la distribución de la masa es extremadamente simple: toda la masa existe como una ma¬ 
sa puntual en el extremo distal de cada vínculo. Estas masas son m 1 y m 2 . 

En primer lugar, vamos a determinar los valores de las diversas cantidades que 
aparecerán en las ecuaciones recursivas de Newton-Euler. Los vectores que ubican el 
centro de masas para cada vínculo son 


v Pr =UX 


t A t> 


P C 2 ~ l 2 X 2- 


Como se supone una masa puntual, el tensor de inercia escrito en el centro de masas 
para cada vínculo es la matriz cero: 


Cl h = 0, 

Cl h = o- 

Como no hay fuerzas actuando en el efector final, tenemos que 

fs = 0, 

« 3 = 0 . 

La base del robot no está girando; por lo tanto, 

«o = 

<¿ 0 = 0 . 



FIGURA 6.6: Manipulador planar de dos vínculos con masas puntuales en los extremos 
distales de los vínculos. 
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Para incluir las fuerzas de gravedad, utilizaremos 
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% = g%- 

La rotación entre tramas de vínculo sucesivas está dada por 



~ c i+1 ~s i+l 0.0“ 

Ui R = 

s i+1 C i + y 0.0 


_ 0.0 0.0 1.0 


1 - 

O 

O 

+ 

>r 

+ 

cr 

i+l R = 

l 

o 

o 

+ 

cr 

+ 

>r 

i 


0.0 0.0 1.0 


Ahora vamos a aplicar las ecuaciones (6.46) a (6.53). 
Las iteraciones salientes para el vínculo 1 son: 


V, = 6y 1 z 1 = 


1 á)y = Oy 1 Z 1 = 


0 

0 

L¿1J 

0 

o 

L¿1 J 


s 


1 • 


Cy Sj 0 

—Cy 0 
0 0 1 


o 

lyOy 

0 



" 0 " 


8 s l 


g 

= 

g c 1 


0 


0 


' 

- -z^ 2 - 


"<? s l" 


" + £ 5 i " 

+ 

0 

+ 

g c 1 

= 

h® i + £ c i 


0 


0 


0 


P\ = 


- mylyO 2 + ITlygSy 
triylyOy + IflygCy 
0 


L N, = 


Las iteraciones salientes para el vínculo 2 son: 


0 
0 

L ¿i + J 


L t?i -r t? 2 j 


(6.54) 


0 

0 
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c 2 s 2 0 

— 7 2 + 


l Á s 2 ~ 7i c 2 + 8*12 

2 ¿ 2 = 

-s 2 c 2 0 

7i + gC\ 

= 

7l c 2 + ^l^ 2 ^ + £ c 12 


0 0 1 

0 


0 



0 

l 2 (0\ + 0 2 ) 
0 


-Z 2 (¿l + Ó 2 ) 2 
o 
o 


i l e l s 2 -i l él c 2 + gs n 

7l c 2 + h&i s 2 + # c 12 

0 


2 


F 2 


m 2 l\ 0\ s 2 - m 2 l^6 2 c 2 + m 2 gs u - m 2 l 2 (é l + Ó 2 ) 2 

m 2 l \Ü\ c 2 + m 2 I ] Ó 2 s 2 + m 2 gc 12 + + 9 2 ) , 

0 


2 


n 2 


o 

o 

o 


(6.55) 


Las iteraciones entrantes para el vínculo 2 son: 



_ m 2 l l l 2 c 2&l + m 2 l \ l 2 s 2®l + m 2 l 2S c \2 + w 2 / 2 (^'l + h) _ 
Las iteraciones entrantes para el vínculo 1 son: 


(6.56) 


7 , = 


c 2 

s 2 

0 ~ 


s 2 

c 2 

0 


0 

0 

1 



m 2 l l s 2Pl ~ m 2 l l c 2&i + m 2S s 12 ~ m 2 l 2^1 + Ó 2 ) 2 

m 2 l l c 2^l + m 2 l l s 2^l + m 2§ c 12 + m 2 l 2$l + h) 
0 


—m^O 2 + m l gs í 

m ] l l 0 l + m 1 gc 1 
0 


0 
0 

m 2 kh c 2^l + m 2 l x l 2 s 2 é 2 + m 2 l 2 gc 12 + m 2 I 2 {6 l + 0 2 ) _ 

0 
0 


_ m jZ-6^ + 


0 

0 


'«2 Z 7'l “ m 2 l l l 2 s 2^1 + 4) 2 + m 2 / l? s 2 í 12 
+ m 2hh c 2 (fil + ^2) + m 2^lS c 2 c 12 


(6.57) 
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Para encontrar los momentos de torsión extraemos los componentes Z de las l n\ 
r j = ttl 2 ^ (0\ 4“ 0 2 ) 4* 1fl 2 l^l 2 C 2 (20^ T ¿2i + Ó** | 4- /n2)6^| — /r/ 2 /1 l 2 ^2^ 2 
-2m 2 l ] l 2 s 2 é^Ó 2 + m 2 l 2 gc l2 + (m 1 + m^gc^ 

r 2 = m lhh c 2 ^l + m 2 hh s 2 ®{ + m 2 hs c \2 + w 2 ^ 2 ^'l + ^ 2 )- (6.58) 

Las ecuaciones (6.58) proporcionan expresiones para el momento de torsión en los 
actuadores como una función de la posición de la articulación, su velocidad y su acelera¬ 
ción. Tenga en cuenta que estas funciones algo complejas surgieron de uno de los manipu¬ 
ladores más simples que pueda imaginarse. Obviamente, las ecuaciones de forma cerrada 
para un manipulador con seis grados de libertad serán considerablemente más complejas. 

6.8 LA ESTRUCTURA DE LAS ECUACIONES DINÁMICAS DE UN MANIPULADOR 

A menudo es conveniente expresar las ecuaciones dinámicas de un manipulador en una 
sola ecuación que oculte algunos de los detalles, pero que muestre parte de la estructu¬ 
ra de las ecuaciones. 

La ecuación en el espacio de estados 

Cuando las ecuaciones de Newton-Euler se evalúan simbólicamente para cualquier ma¬ 
nipulador, producen una ecuación dinámica que puede escribirse de la siguiente forma 

r = M(©)0 4- T(0, 0) 4- G(0), (6.59) 

en donde M(Q ) es la matriz de masas de n x n del manipulador, U(©, 0) es un vector 
de n x 1, de términos centrífugos y Coriolis, y G(0) es un vector de n x 1, de términos de 
gravedad. Utilizaremos el término ecuación en el espacio de estados porque el término 
U(©, ©), que aparece en la ecuación (6.59) tiene dependencias tanto de posición como 
de velocidad [3]. 

Cada elemento de M(0) y de G(@) es una función compleja que depende de ©, 
la posición de todas las articulaciones del manipulador. Cada elemento de U(0, 0) es 
una función compleja tanto de 0 como de ©. 

Podemos separar los diversos tipos de términos que aparecen en las ecuaciones 
dinámicas y formar la matriz de masas del manipulador, el vector centrífugo y de Co¬ 
riolis, y el vector de gravedad. 


EJEMPLO 6.3 

Proporcione los valores de M(0), U(0, 0) y G(0) para el manipulador de la sección 6.7. 

La ecuación (6.59) define la matriz de masas del manipulador, M(0); está compuesta 
de todos los términos que multiplican a © y es una función de 0. Por lo tanto, tenemos que 

l^in 2 + 2I 1 l 2 m 2 c 2 + l^(m 1 + m 2 ) í^m 2 4- lil 2 m 2 c 2 


M(0) = 


U m 2 + l l l 2 m 2 c 2 


l¡m 2 


(6.60) 


Cualquier matriz de masas de un manipulador es simétrica y está definida como positi¬ 
va; por lo tanto, siempre es invertible. 

El término velocidad U(0, 0) contiene todos los elementos de cualquier depen¬ 
dencia en la velocidad de las articulaciones. Por lo tanto, 


y(0, ©) 


~ m 2hh s 2^ 2 — ^ m 2hh s 2^2 

m 2 hl 2 ^l 


(6.61) 
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Un término como —m 2 l 1 l 2 s 2 62 se produce por una fuerza centrífuga, y se reconoce co¬ 
mo tal, debido a que depende de la raíz cuadrada de una velocidad de articulación. Un 
término como —2m 2 l ] l 2 s 2 8 ] 0 2 se produce por una fuerza de Coriolis y siempre contie¬ 
ne el producto de dos velocidades de articulación distintas. 

El término de gravedad G(©) contiene todos los términos en los que aparece la 
constante gravitacional g. Por lo tanto, tenemos que 


G(©) = 


mihSCu + (m 1 + m 2 )l 1 gc 1 
m 2 l l8 c l2 


(6.62) 


Tenga en cuenta que el término de gravedad depende solamente de 0 y no de sus 
derivadas. 


La ecuación en el espacio de configuración 

Si escribimos el término dependiente de la velocidad U(0, 0) en una forma distinta, 
podemos escribir las ecuaciones dinámicas así: 

r = M(©)0 + fl(0)[©0] + C(©)[© 2 ] + G(©), (6.63) 

en donde 5(0) es una matriz de dimensiones n x n(n — l)/2 de coeficientes de Corio¬ 
lis; [0 0] es un vector de n{n — l)/2 x 1 de productos de velocidad de articulación 
dados por 

[00] = [¥ 2 ¥ 3 Ó„-1 Ó n ] T , (6.64) 

C(0) es una matriz de n x n de coeficientes centrífugos y [0 2 ] es un vector den x 1 
dado por 

[0 2 0 2 ...Ó 2 f. (6.65) 

Llamaremos a (6.63) la ecuación en el espacio de configuración, ya que las matrices son 
solamente funciones de la posición del manipulador [3]. 

En esta forma de las ecuaciones dinámicas, la complejidad del cálculo está en la 
forma de calcular varios parámetros que son solamente una función de la posición del 
manipulador (©). Esto es importante en aplicaciones (como el control computacional 
de un manipulador) en las que las ecuaciones dinámicas deben actualizarse a medida 
que se mueve el manipulador. [La ecuación (6.63) proporciona una forma en la que los 
parámetros son una función de la posición de articulación solamente y pueden actuali¬ 
zarse en una proporción relacionada con la rapidez con la que el manipulador cambia 
de configuración]. En el capítulo 10 consideraremos de nuevo esta forma cuando vea¬ 
mos el problema del control del manipulador. 


EJEMPLO 6.4 

Proporcione los valores de 5(0) y C(©) [de la ecuación (6.63)] para el manipulador de 
la sección 6.7. 

Para este manipulador simple de dos vínculos tenemos que 


[00] = [ 6 ^], 


[é> 2 ] = 



( 6 . 66 ) 
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B(®) = 


—2m 2 l}l2 s 2 

0 


(6.67) 


y 


C(0) = 


0 — m 2hh s 2 

m 2 l \ l 2 s 2 0 


( 6 . 68 ) 


6.9 FORMULACIÓN LAGRANGIANA DE LA DINÁMICA DE MANIPULADORES 


El método de Newton-Euler se basa en las fórmulas dinámicas elementales (6.29) y (6.30) 
y en el análisis de fuerzas y momentos de restricción que actúan entre los vínculos. Co¬ 
mo una alternativa para el método de Newton-Euler, en esta sección presentaremos 
brevemente la formulación dinámica lagrangiana. Podría decirse que la formulación de 
Newton-Euler es un método de “balance de fuerzas” dinámicas, y que la formulación 
lagrangiana es un método de “balance de energías” de la dinámica. Desde luego, para 
el mismo manipulador, ambos métodos proporcionarán las mismas ecuaciones de mo¬ 
vimiento. Nuestra definición de la dinámica lagrangiana será breve y algo especializa¬ 
da en el caso de un manipulador mecánico de cadena serial con vínculos rígidos. Para 
obtener una referencia más completa y general, vea [4]. 

Empezaremos desarrollando una expresión para la energía cinética de un manipula¬ 
dor. La energía cinética del í-ésimo vínculo, que llamaremos k p puede expresarse como 


k i = \ m i v l v c l 


1 Í,T C: 


h ‘c 


(6.69) 


en donde el primer término es la energía cinética debida a la velocidad lineal del centro 
de masas del vínculo, y el segundo término es la energía cinética debida a la velocidad 
angular del vínculo. La energía cinética total del manipulador es la suma de la energía 
cinética en los vínculos individuales; esto es: 


n 

k = j2 k ¡- ( 6 - 7 °) 

i=1 

Las v c . e '&>• en la ecuación (6.69) son funciones de © y de 0, por lo que podemos ver 
que la energía cinética de un manipulador puede describirse mediante una fórmula es¬ 
calar como una función de la posición de articulación y la velocidad, k(&, 0). De he¬ 
cho, la energía cinética de un manipulador se da mediante 


k(&, 0) = ±© r M(©)0, (6.71) 

en donde M(0) es la matriz de masas de n x n del manipulador, que ya presentamos en 
la sección 6.8. Una expresión con la forma de la ecuación (6.71) se conoce como forma 
cuadrática [5], ya que cuando se expande, la ecuación escalar resultante está compues¬ 
ta únicamente de términos cuya dependencia sobre los 6 ¡ es cuadrática. Además, como la 
energía cinética total debe ser siempre positiva, la matriz de masas del manipulador de¬ 
be ser una matriz definida positiva. Este tipo de matrices tienen la propiedad de que su 
forma cuadrática siempre es un escalar positivo. La ecuación (6.71) puede verse como 
análoga a la expresión familiar para la energía cinética de una masa puntual: 


k = 


i?nv 


2 


(6.72) 
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El hecho de que la matriz de masas de un manipulador deba ser definida positiva, es 
análogo al hecho de que una masa escalar sea siempre un número positivo. 

La energía potencial del /-ésimo vínculo, que llamaremos u p puede expresarse como 

“i = ~ m i °g T ° p c ¡ + u ref ¡ - (6-73) 

en donde °g es el vector de gravedad de 3 x 1; °P C . es el vector que ubica al centro de 
masas del z-ésimo vínculo, y u n ,¡, es una constante que se elige de manera que el valor 
mínimo de u i sea cero. 1 La energía potencial total almacenada en el manipulador es la 
suma de la energía potencial en los vínculos individuales; esto es: 

n 

« = £>,.. (6-74) 

¿=l 

Como las °P C . en la ecuación (6.73) son funciones de ©, podemos ver que la ener¬ 
gía potencial de un manipulador puede describirse mediante una fórmula escalar como 
una función de la posición de articulación, «(0). 

La formulación dinámica lagrangiana provee los medios para derivar las ecuacio¬ 
nes de movimiento a partir de una función escalar llamada lagrangiano, que se define 
como la diferencia entre la energía cinética y potencial de un sistema mecánico. En 
nuestra notación, el lagrangiano de un manipulador es 

£(©, 0) = k(®, ©) — «(©). (6.75) 


Y las ecuaciones de movimiento para el manipulador se dan entonces así: 

d dC dC _ 

dt 3© 3© ~~ T ’ 

en donde r es el vector de n x 1 de momentos de torsión de los actuadores. En el caso 
de un manipulador, esta ecuación se convierte en 

d 3 k dk 3 u 
di 3© 30 3© 

en donde por brevedad hemos omitido los argumentos de k(-) y zz(-). 


(6.76) 


(6.77) 


EJEMPLO 6.5 

Los vínculos de un manipulador RP, que se muestran en la figura 6.7, tienen los siguien¬ 
tes tensores de inercia: 




Cl h = 


4*1 

o 

o 

4*2 

o 

o 


l yyl 

0 


l yy2 


0 

0 

hzl 

0 

o 


o / 


zz2 


(6.78) 


1 En realidad, sólo aparecerá en los cálculos dinámicos la derivada parcial de la energía potencial con 
respecto a 0, por lo que esta constante es arbitraria. Esto corresponde a definir la energía potencial relati¬ 
va a una altura de referencia arbitraria con valor de cero. 
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FIGURA 6.7: El manipulador RP del ejemplo 6.5. 


y las masas totales m 1 y m T Como se muestra en la figura 6.7, el centro de masas del víncu¬ 
lo 1 se encuentra a una distancia ^ del eje de la articulación 1, el centro de masas del 
vínculo 2 se encuentra a una distancia variable d 2 del eje de la articulación 1. Use diná¬ 
mica lagrangiana para determinar la ecuación de movimiento para este manipulador. 

Utilizando la ecuación (6.69), podemos escribir la energía cinética del vínculo 1 
como: 


*t = + kri ¿i (6-79) 

y la energía cinética del vínculo 2 como 

k 2 = i m 2 (d¡9¡ + d\) + \l zz2 (6.80) 

Por lo tanto, la energía cinética total se obtiene mediante 

k(&, ©) = + I zz i + /,_2 + m 2 d~)0~ + ^m 2 d~. (6.81) 

Si utilizamos la ecuación (6.73), podemos escribir la energía potencial del vínculo 1 como 

= m^l^g seníé^) + m^l^g (6.82) 

y la energía potencial del vínculo 2 como 

«2 = m 2 gd 2 senídj) + m 2 gd 2máx , (6.83) 

en donde d 2müx es la extensión máxima de la articulación 2. Por ende, la energía poten¬ 
cial total se obtiene mediante 


m(0) = g{m x l x + m 2 d 2 ) sen^) + m 1 l l g + m 2 gd 2máx . 


(6.84) 
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Ahora vamos a tomar derivadas parciales según sea necesario para la ecua¬ 
ción (6.77): 


dk 

( m l + hzl + hz2 + m 2 d 2 )9\ 

9Ó ~~ 


ni 2 d 2 

- 

dk 

' 0 ' 



90 ~ 

. m 2 d 2 Ó 2 _ 

’ 


du 

g(w 1 / 1 + m 2 d 2 ) cos(ü 1 ) 


90 “ 

gm 2 sen 09,) 



(6.85) 

( 6 . 86 ) 

(6.87) 


Por último, sustituyendo en la ecuación (6.77) tenemos que 

T 1 = ("Vi + hzl + hz2 + m 2 d 2 )6 l + 2 m 2 d 2 d 1 d 2 

+(m 1 / 1 + m 2 d 2 )g cos^j), (6.88) 

•• • j 

r 2 = m 2 d 2 — m 2 d 2 0^ + m 2 g senfí^). 


De la ecuación (6.89) podemos ver que 

('V? + hz\ + I zz2 + m 2 d l'> 0 


M(@) = 

P(0, 0) = 

G(&) = 


1 ’ r ‘zz 1 ^ ‘zz2 ' "-¿" 2 > 

0 m 2 


2 m 2 d 2 6]d 2 

-m 2 d 2 6 2 l 


{m l l l + m 2 d 2 )g cos^j) 
m 2 gsen(6» 1 ) 


(6.89) 


6.10 FORMULACIÓN DE LA DINÁMICA DE MANIPULADORES EN ESPACIO CARTESIANO 

Nuestras ecuaciones dinámicas se han desarrollado en términos de las derivadas de posi¬ 
ción y tiempo de los ángulos de articulación del manipulador, o en el espacio de articu¬ 
lación, con la siguiente forma general: 

r = M(©)0+V(0,0) + G(0). (6.90) 

Desarrollamos esta ecuación en el espacio de articulación dado que podíamos usar la 
naturaleza de vínculo serial del mecanismo como ventaja al derivar las ecuaciones. En 
esta sección hablaremos sobre la formulación de las ecuaciones dinámicas que relacio¬ 
nan la aceleración del efector final expresada en espacio cartesiano, con las fuerzas y 
momentos cartesianos que actúan en el efector final. 

La ecuación en el espacio de estados cartesiano 

Como explicaremos en los capítulos 10 y 11, podría ser conveniente expresar la diná¬ 
mica de un manipulador con respecto a variables cartesianas de la siguiente forma [6]: 


T = M x (&)x + V X (Q, 0) + G x (0), 


(6.91) 















186 Capítulo 6 


Dinámica de manipuladores 


en donde T es un vector de fuerza-momento de torsión que actúa en el efector final del 
robot, y / es un vector cartesiano apropiado que representa la posición y la orientación 
del efector final [7], M x (&), que es análoga a la cantidades en el espacio de articulación, 
es la matriz de masas cartesiana, V X {G), 0) es un vector de términos de velocidad en el es¬ 
pacio cartesiano, y G Y (0) es un vector de términos de gravedad en el espacio cartesia¬ 
no. Tenga en cuenta que los actuadores podrían, de hecho, aplicar en las articulaciones 
las fuerzas ficticias T que actúan en el efector final, usando la siguiente relación: 

r = 7 r (0)7 r , (6.92) 

en donde el jacobiano /(©) está escrito en la misma trama que T y x, que generalmen¬ 
te es la trama herramienta {T}. 

Podemos derivar la relación entre los términos de las ecuaciones (6.90) y (6.91) 
de la siguiente manera. Primero multiplicamos del lado izquierdo la ecuación (6.90) por 


la inversa de la transpuesta del jacobiano para obtener 

J~ t t = J~ r M(&)& + J~ T V(@, 0) + (6.93) 

O 

T = J~ t M(&)@ + J~ T V(& , 0) + J~ T G(&). (6.94) 

Después desarrollamos una relación entre el espacio de articulación y la aceleración 
cartesiana, empezando con la definición del jacobiano: 

X = 70, (6-95) 

y diferenciando para obtener 

X = 70 + 70. (6.96) 

Resolviendo la ecuación (6.96) para la aceleración del espacio de articulación llegamos a 

0 = 7 _1 x - 7 _1 70. (6.97) 

Si sustituimos la ecuación (6.97) en la (6.94), tenemos 

T = J~ T M(@)J~ l x - 7“ :r M(0)7“ 1 70 + J~ T V(&, 0) + J~ T G(&), (6.98) 

de esta ecuación derivamos las expresiones para los términos en la dinámica cartesiana: 
M x (0) = 7“ 7 ’(©)M(©)7“ 1 (0), 

V T (0, 0) = J~ T m(V(&, 0) - M(©)7 _1 (0)7(©)©), (6.99) 

G x (&) = 7- r (0)G(0). 


Observe que el jacobiano que aparece en las ecuaciones (6.100) está escrito en las 
mismas tramas que T y x en la ecuación (6.91); la elección de esta trama es arbitraria. 2 
Observe que cuando el manipulador se acerca a una singularidad, ciertas cantidades en 
la dinámica cartesiana se vuelven infinitas. 


2 Ciertas elecciones podrían facilitar los cálculos computacionales. 
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EJEMPLO 6.6 

Derive la forma de espacio cartesiano de la dinámica para el brazo planar de dos víncu¬ 
los de la sección 6.7. Escriba la dinámica en términos de una trama unida al extremo 
del segundo vínculo. 

Para este manipulador ya hemos obtenido la dinámica (en la sección 6.7) y el ja- 
cobiano [ecuación (5.66)], cuyas ecuaciones redefiniremos aquí: 


/(©) = 

Primero, calcule la inversa del jacobiano: 

1 


h s 2 0 
h c i + h h 


J~\@) = 


hh s 2 


0 


~h c 2 ~ h k s 2 

Después obtenga la derivada con respecto al tiempo del jacobiano: 


( 6 . 100 ) 


( 6 . 101 ) 


j (©) = 


k c 2^2 0 
~h s 2@2 0 


( 6 . 102 ) 


Con la ecuación (6.100) y los resultados de la sección 6.7, obtenemos 


M x (@) = 


'«i 

7T 

S 2 


0 

m 2 


V x (0,0) = 


G x (&) = 


< m 2 l i c 2 + m 2 l 2 )Ól - m 2 l 2 0 l - (2 m 2 l 2 + m 2 l 1 c 2 + m 1 l 1 -^)9 1 Ó 2 

■7 • • $2 

m 2¡l s 2^i + k m 2 s 2@l@2 


C 1 

m l g—+m 2 gs 12 

s 2 

m 2S c \2 


(6.103) 


Cuando s 2 = 0, el manipulador está en una posición singular, y algunos de los térmi¬ 
nos de dinámica se hacen infinitos. Por ejemplo, cuando 9 2 = 0 (el brazo completamente 
estirado), la masa cartesiana efectiva del efector final se vuelve infinita en la dirección X 2 
de la trama de la punta con dos vínculos, según lo esperado. En general, en una configu¬ 
ración singular existe cierta dirección, la dirección singular , en la que es imposible mover¬ 
se, pero es posible moverse en el subespacio “ortogonal” a esta dirección [8]. 


La ecuación de momento de torsión en el espacio de configuración cartesiana 

Si combinamos las ecuaciones (6.91) y (6.92), podemos escribir momentos de torsión 
de articulación equivalentes con la dinámica expresada en espacio cartesiano: 

r = J T (®)(M x (®)x + V x (®, 0) + G x (®)). (6-104) 

Será de mucha utilidad escribir esta ecuación de la siguiente forma: 

r = J T (®)M x (@)x + B,(©)[©0] + C v (©)[0 2 ] + G(0), 


(6.105) 
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en donde 5 v (0) es una matriz de dimensión n x n(n — l)/2 de coeficientes de Coriolis, 
[0 0] es un vector de n(n — l)/2 x 1 de productos de velocidad de articulación definidos por 

[00] = [0,02 0j é 3 ... é n _ 1 é n f, (6.106) 

C ( 0) es una matriz de n x n de coeficientes centrífugos, y [0 2 ] es un vector den x 1 
definido por 

[0¡d¡...óy. (6.107) 

Observe que en la ecuación (6.105), G(0) es igual que en la ecuación de espacio de ar¬ 
ticulación, pero en general, B x (Q) ^ 5(0) y C x (&) ^ C(0). 


EJEMPLO 6.7 

Encuentre 5 v (0) y C Y (0) [de la ecuación (6.105)] para el manipulador de la sección 6.7. 
Si formamos el producto / r (0)U v (0, 0), encontraremos que 


5.(0) = 


m l l l% - m 2 l l l 2 s 2 

m 2 l l l 2 s 2 


(6.108) 


C v (©) = 


0 —m 2 / 1 / 2 S2 

m 2 l \ l 2 s 2 0 


(6.109) 


6.11 INCLUSIÓN DE LOS EFECTOS DE CUERPOS NO RÍGIDOS 

Es importante tener en cuenta que las ecuaciones dinámicas que hemos derivado no 
abarcan todos los efectos que actúan sobre un manipulador , sólo incluyen aquellas fuer¬ 
zas que surgen de mecanismos de cuerpo rígido y la fuente más importante de fuerzas 
que no se incluyen es la fricción. Es evidente que todos los mecanismos se ven afecta¬ 
dos por fuerzas de fricción. En los manipuladores actuales, en los que es común tener 
una cantidad considerable de engranajes, las fuerzas debidas a la fricción pueden ser 
bastante grandes; tal vez sean equivalentes al 25 % del momento de torsión requerido 
para mover el manipulador en situaciones comunes. 

Para poder hacer que las ecuaciones dinámicas reflejen la realidad del dispositi¬ 
vo físico es importante modelar (cuando menos aproximadamente) estas fuerzas de 
fricción. Un modelo muy simple de la fricción es la fricción viscosa, en la que el mo¬ 
mento de torsión debido a la fricción es proporcional a la velocidad del movimiento de 
la articulación. Por lo tanto, tenemos que 

z fricción ^Ó, (6.110) 

en donde v es una constante de fricción viscosa. Otro posible modelo simple para la 
fricción es la fricción de Coulomb, que se utiliza ocasionalmente. La fricción de Cou¬ 
lomb es constante excepto por una dependencia de signo en la velocidad de una articu¬ 
lación, y se define así: 

z fricdón = c s S n( fi), (6.111) 

en donde c es una constante de fricción de Coulomb. El valor de c se toma comúnmen¬ 
te a cierto valor cuando 0 = 0, el coeficiente estático, pero a un menor valor, el coefi¬ 
ciente dinámico, cuando 0 ^ 0. El que una articulación de un manipulador específico 
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exhiba fricción viscosa o de Coulomb es una cuestión complicada de lubricación y otros 
efectos. Un modelo razonable es incluir ambas, ya que las dos son muy probables: 

fricción = c s 8 n (Ó) + VÓ. (6.112) 

En muchas articulaciones de manipuladores, la fricción también muestra una de¬ 
pendencia en la posición de la articulación. Una de las causas principales de este efec¬ 
to podría ser que los engranajes no sean perfectamente redondos; su excentricidad 
haría que la fricción cambiara de acuerdo con la posición de la articulación. Entonces, 
un modelo de fricción relativamente complejo tendría la siguiente forma: 

rfricción=f(0,é). (6.113) 

Estos modelos de fricción se añaden a los demás términos dinámicos derivados del mo¬ 
delo de cuerpo rígido, produciendo el siguiente modelo más completo: 

r = M(©)0 + V(@, 0) + G(0) + F(0, 0). (6.114) 

Existen también otros efectos que se pasan por alto en este modelo. Por ejemplo, 
la suposición de vínculos de cuerpo rígido significa que no hemos incluido los efectos 
de flexión (que producen resonancias) en nuestras ecuaciones de movimiento. No obs¬ 
tante, estos efectos son extremadamente difíciles de modelar y están más allá del alcan¬ 
ce de este libro (vea las referencias [9 y 10].) 

6.12 SIMULACIÓN DINÁMICA 

Para simular el movimiento de un manipulador, debemos hacer uso de un modelo de la 
dinámica tal como el que acabamos de desarrollar. Dada la dinámica escrita en forma 
cerrada como en la ecuación (6.59), la simulación requiere resolver la ecuación dinámi¬ 
ca para la aceleración: 

© = M“ 1 (0)[r - V(0, 0) - G(0) - F(0, ©)]. (6.115) 

Entonces podemos aplicar una de las diversas técnicas de integración numérica cono¬ 
cidas para integrar la aceleración y calcular las posiciones y velocidades futuras. 

Dadas las condiciones iniciales en el movimiento del manipulador, generalmente 
en la forma 

©(0) = ©o, 

0(0) = 0, (6.116) 

integramos la ecuación (6.115) avanzando en el tiempo numéricamente, en intervalos 
de tamaño A t. Existen muchos métodos para realizar la integración numérica [11]. Aquí 
presentaremos el esquema de integración más simple, llamado integración de Euler. 
Empezando con t = 0, calcule iterativamente 

0(í + A t) = 0(í) + 0(í)Aí, 

0(í + A t) = &(t) + &(t)At + Í0(r)At 2 , (6.117) 

en donde, para cada iteración, se emplea la ecuación (6.115) para calcular 0. De esta 
manera, la posición, la velocidad y la aceleración del manipulador, producidas por cier¬ 
ta función de momento de torsión de entrada, pueden calcularse numéricamente. 

La integración de Euler es conceptualmente simple, pero para una simulación 
precisa y eficiente se recomiendan otras técnicas de integración más sofisticadas [11]. 
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La forma de seleccionar el tamaño de A t es una cuestión que se discute muy a menudo. 
Debe ser lo suficientemente pequeña para que el proceso de descomponer el tiempo 
continuo en estos pequeños incrementos sea una aproximación razonable y debe ser lo 
suficientemente grande como para no requerir una excesiva cantidad de tiempo de 
computadora para calcular una simulación. 

6.13 CONSIDERACIONES COMPUTACIONALES 

Como las ecuaciones dinámicas de movimiento para los manipuladores comunes son 
tan complejas, es importante considerar las cuestiones computacionales. En esta sec¬ 
ción restringiremos nuestra atención a la dinámica de espacio de articulación. En las re¬ 
ferencias [7 y 8] se habla sobre algunas cuestiones de eficiencia computacional de la 
dinámica cartesiana. 

Una observación histórica en relación con la eficiencia 

Si contamos el número de multiplicaciones y sumas para las ecuaciones (6.46) a (6.53) 
al tomar en cuenta el primer cómputo saliente simple y el último cómputo entrante sim¬ 
ple, obtenemos: 


126/z — 99 multiplicaciones, 

106« — 92 sumas, 

en donde n es el número de vínculos (aquí son por lo menos dos). Aunque la formulación 
sigue siendo algo compleja, es muy eficiente en comparación con algunas formulaciones 
de dinámica de manipuladores sugeridas previamente. La primera formulación de la diná¬ 
mica para un manipulador [12,13] se hizo mediante un método Lagrangiano muy simple, 
cuyos cálculos requeridos resultaron ser aproximadamente [14] 

32 n 4 + 86 n 3 + llln 2 + 53 n — 128 multiplicaciones, 

25 n 4 + 66 n 3 + 129 n 2 + 42 n — 96 sumas. 

Para un caso típico en el que n — 6, el esquema iterativo de Newton-Euler es apro¬ 
ximadamente 100 veces más eficiente. Por supuesto que los dos métodos deben producir 
ecuaciones equivalentes, y los cálculos numéricos producirían exactamente los mismos 
resultados, pero la estructura de las ecuaciones es muy distinta; esto no quiere decir que 
no pueda crearse un método lagrangiano para producir ecuaciones eficientes. Lo que esta 
comparación indica es que para formular un esquema computacional para este problema 
hay que tener mucho cuidado en cuanto a la eficiencia. La eficiencia relativa del método 
que hemos presentado proviene de plantear los cálculos como iteraciones de vínculo en 
vínculo y, en especial, de cómo se representan las diversas cantidades [15]. 

Renaud [16], Liegois y otros [17] hicieron las primeras contribuciones en lo que 
se refiere a la formulación de las descripciones de la distribución de masa de los vínculos. 
Mientras estudiaban el modelado de los miembros humanos, Stepanenko y Vukobra- 
tovic [18] empezaron a investigar un método de “Newton-Euler” para la dinámica, en 
vez del método lagrangiano que era algo más convencional. Orin y otros [19] revisaron 
la eficiencia de este trabajo aplicándolo a las piernas de robots que caminaban. El gru¬ 
po de Orin mejoró un tanto la eficiencia al escribir las fuerzas y momentos en las tra¬ 
mas de referencia de los vínculos locales en vez de hacerlo en la trama inercial. También 
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observaron la naturaleza secuencial de los cálculos de un vínculo al siguiente y especu¬ 
laron que podría existir una eficiente formulación recursiva. Armstrong [20] y Luh, 
Walker y Paul [2] pusieron mucha atención a los detalles de la eficiencia y publicaron 
un algoritmo que es O(n) en complejidad; para ello establecieron los cálculos en una 
naturaleza iterativa (o recursiva) y expresaron las velocidades y aceleraciones de los 
vínculos en las tramas de vínculos locales. Hollerbach [14] y Silver [15] exploraron 
más a fondo varios algoritmos computacionales. Hollerbach y Sahar [21] demostra¬ 
ron que para ciertas geometrías especializadas, la complejidad del algoritmo se redu¬ 
ciría aún más. 

Comparación entre la eficiencia de forma cerrada y la de forma iterativa 

El esquema iterativo que presentamos en este capítulo es bastante eficiente como un 
medio general para calcular la dinámica de cualquier manipulador, pero las ecuaciones 
de forma cerrada que se deriven para un manipulador específico serán por lo general 
más eficientes. Considere el manipulador planar de dos vínculos de la sección 6.7. Si 
utilizamos n — 2 en las fórmulas dadas en la sección 6.13, veremos que nuestro esque¬ 
ma iterativo requiere de 153 multiplicaciones y 120 sumas para calcular la dinámica de 
un manipulador general de dos vínculos. Sin embargo, ocurre que nuestro brazo espe¬ 
cífico de dos vínculos es bastante simple: es planar y las masas se tratan como masas 
puntuales. Por lo tanto, si consideramos las ecuaciones de forma cerrada que ideamos 
en la sección 6.7, veremos que el cálculo de la dinámica en esta forma requiere de apro¬ 
ximadamente 30 multiplicaciones y 13 sumas. Éste es un caso extremo ya que el mani¬ 
pulador específico es muy simple, pero ilustra la idea de que es muy probable que las 
ecuaciones simbólicas de forma cerrada sean la formulación más eficiente de la diná¬ 
mica. Varios autores han publicado libros mostrando que, para cualquier manipulador 
dado, la dinámica de propósito específico con forma cerrada es más eficiente que inclu¬ 
so el mejor de los esquemas generales [22-27]. 

Por ende, si los manipuladores se diseñan para ser simples , en los sentidos cinemá¬ 
tico y dinámico, tendrán ecuaciones dinámicas simples. Podríamos definir un manipula¬ 
dor cinemáticamente simple como un manipulador que tiene muchas de (o todas) sus 
torsiones de vínculo iguales a 0, 90 o —90° y muchas de sus longitudes y desplazamientos 
de vínculo iguales a cero. Podríamos definir al manipulador dinámicamente simple como 
uno para el cual cada tensor de inercia de vínculo es diagonal en la trama [Cj¡. 

La desventaja de formular ecuaciones de forma cerrada es simplemente que en la 
actualidad se requiere una considerable cantidad de esfuerzo humano. No obstante, se 
han desarrollado programas de manipulación simbólica que pueden derivar las ecua¬ 
ciones de forma cerrada del movimiento de un dispositivo y que automáticamente fac- 
torizan los términos comunes y realizan sustituciones trigonométricas [25, 28-30]. 

Dinámica eficiente para la simulación 

Cuando se va a calcular la dinámica con el propósito de llevar a cabo la simulación nu¬ 
mérica de un manipulador, nos interesa resolver para las aceleraciones de las articulacio¬ 
nes, dadas la posición y velocidad actuales del manipulador y los momentos de torsión de 
entrada. Por lo tanto, un esquema computacional eficiente deberá encargarse del cálcu¬ 
lo de las ecuaciones dinámicas que estudiamos en este capítulo y de los esquemas efi¬ 
cientes para resolver ecuaciones (para las aceleraciones de las articulaciones), además 
de realizar la integración numérica. En la referencia [31] se reportan varios métodos 
eficientes para la simulación dinámica de manipuladores. 
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Esquemas de memorización 

En cualquier esquema computacional puede hacerse un intercambio entre los cálculos 
y el uso de la memoria. En el problema de calcular la ecuación dinámica de un mani¬ 
pulador (6.59) hemos supuesto implícitamente que, cuando se necesita un valor de r, se 
calcula lo más rápido posible a partir de 0, © y 0 en tiempo de ejecución. Si queremos, 
podemos intercambiar esta carga computacional por el costo de un requerimiento tre¬ 
mendamente grande de memoria, al calcular por anticipado la ecuación (6.59) para 
todos los valores posibles de 0, 0 y 0 (cuantifícados adecuadamente). Más adelante, 
cuando se necesite la información dinámica podremos encontrar la respuesta buscando 
en una tabla. 

El tamaño de la memoria requerida es grande. Suponga que el rango de cada án¬ 
gulo de articulación se cuantifica a diez valores discretos; de igual forma, suponga que 
las velocidades y las aceleraciones se cuantifican a diez rangos cada una. Para un mani¬ 
pulador de seis articulaciones, el número de celdas en el espacio cuantificado de (0, 0 
y 0) es (10 x 10 x 10) 6 . En cada una de estas celdas hay seis valores de momento de 
torsión. Suponiendo que cada valor de momento de torsión requiere de una palabra 
de computadora, ¡el tamaño de esta memoria sería de 6 x 10 18 palabras! Además, ob¬ 
serve que la tabla necesita recalcularse para un cambio en la masa de la carga; o se ne¬ 
cesita agregar otra dimensión para tener en cuenta todas las cargas posibles. 

Hay muchas soluciones intermedias que intercambian de varias formas la memoria 
por el cálculo. Por ejemplo, si las matrices que aparecen en la ecuación (6.63) se calcu¬ 
laran previamente, la tabla sólo tendría una dimensión (en 0) y no tres. Después de lo¬ 
calizar las funciones de © se lleva a cabo una modesta cantidad de cálculos [mediante 
la ecuación (6.63)]. Para obtener más detalles y para otras posibles parametrizaciones 
de este problema, vea las referencias [3] y [6]. 
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EJERCICIOS 

6.1 [12] Encuentre el tensor de inercia de un cilindro recto de densidad homogénea res¬ 
pecto a una trama con el origen en el centro de masas del cuerpo. 

6.2 [32] Construya las ecuaciones dinámicas para el manipulador de dos vínculos en la 
sección 6.7 cuando cada vínculo se modela como un sólido rectangular de densidad 
homogénea. Cada vínculo tiene las dimensiones / ; , a>¡ y h¡, y una masa total represen¬ 
tada por m¡. 

6.3 [43] Construya las ecuaciones dinámicas para el manipulador de tres vínculos del ca¬ 
pítulo 3, ejercicio 3.3. Considere que cada vínculo es un sólido rectangular de densi¬ 
dad homogénea con las dimensiones /., a>¡ y h¡, y una masa total rrr. 

6.4 [13] Escriba el conjunto de ecuaciones que corresponden a las ecuaciones (6.46) a la 
(6.53) para el caso en el que el mecanismo podría tener articulaciones deslizables. 

6.5 [30] Construya las ecuaciones dinámicas para el manipulador no planar de dos víncu¬ 
los que se muestra en la figura 6.8. Suponga que toda la masa de los vínculos puede 
considerarse como una masa puntual ubicada en el extremo distal (más externo) del 
vínculo. Los valores de las masas son wq y m 2 , y las longitudes de los vínculos son f y 
l T Este manipulador es como los primeros dos vínculos del brazo en el ejercicio 3.3. 
Suponga además que hay fricción viscosa actuando en cada vínculo, con los coeficien¬ 
tes v 1 y v 2 . 

6.6 [32] Derive la forma de espacio cartesiano de la dinámica para el manipulador planar 
de dos vínculos de la sección 6.7 en términos de la trama base. Sugerencia : vea el ejem¬ 
plo 6.5, pero utilice el jacobiano escrito en la trama base. 



FIGURA 6.8: Manipulador no planar de dos vínculos con masas puntuales en los extre¬ 
mos distales de los vínculos. 
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6.7 [18] ¿Cuántas localidades de memoria se requerirían para almacenar las ecuaciones 
dinámicas de un manipulador general de tres vínculos en una tabla? Cuantifique la 
posición, velocidad y aceleración de cada articulación en 16 rangos. Haga todas las 
suposiciones necesarias. 

6.8 [32] Derive las ecuaciones dinámicas para el manipulador de dos vínculos que se mues¬ 
tra en la figura 4.6. El vínculo 1 tiene un tensor de inercia dado por 


Ct/ = 


xxl u u 
0 Iyyl 0 

0 o I zzl J 


Suponga que el vínculo 2 tiene toda su masa m 2 ubicada en un punto en el efector fi¬ 
nal. Suponga que la gravedad se dirige hacia abajo (en dirección opuesta a Zj). 

6.9 [37] Derive las ecuaciones dinámicas para el manipulador de tres vínculos con una articu¬ 
lación prismática, mostrado en la figura 3.9. El vínculo 1 tiene un tensor de inercia dado por 


C\I = 


xxl u u 
0 Iyyl 0 

0 0 4,1 J 


El vínculo 2 tiene la masa puntual m 2 ubicada en el origen de su trama de vínculo. El 
vínculo 3 tiene un tensor de inercia dado por 


C 3 I = 


Ixx3 0 0 ' 

0 Iyy3 0 

0 0 4,3 J 


Suponga que la gravedad se dirige en forma opuesta a Z x y que hay fricción viscosa de 
magnitud v. activa en cada articulación. 

6.10 [35] Derive las ecuaciones dinámicas en espacio cartesiano para el manipulador del 
ejercicio 6.8. Escriba las ecuaciones en la trama [2]. 

6.11 [20] Cierto manipulador de un vínculo tiene 


C,I = 


4,t o 

0 Iyy 

0 o 


o 

o 


Suponga que ésta es sólo la inercia del vínculo en sí. Si la armadura del motor tiene 
un momento de inercia / y la proporción de engranaje es de 100, ¿cuál es la inercia 
total vista desde el eje del motor [1]? 

6.12 [20] El “manipulador” de un solo grado de libertad en la figura 6.9 tiene una masa to¬ 
tal m = 1, con el centro de masas en 


y tiene un tensor de inercia 



2 

0 

0 


c 


h = 


1 0 0 
0 2 0 
0 0 2 


Desde el resto a t — 0, el ángulo de articulación 0 1 se mueve de acuerdo con la función 
de tiempo 

6>j (í) = bt + ct 2 

en radianes. Proporcione la aceleración angular del vínculo y la aceleración lineal del 
centro de masas en términos de la trama [1] como una función de t. 
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FIGURA 6.9: “Manipulador” de un vínculo del ejercicio 6.12. 


6.13 [40] Construya las ecuaciones dinámicas cartesianas para el manipulador no planar de 
dos vínculos que se muestra en la figura 6.8. Suponga que toda la masa de los vínculos 
puede considerarse como una masa puntual ubicada en el extremo distal (más exter¬ 
no) del vínculo. Los valores de las masas son m l y m 2 , y las longitudes de los vínculos 
son l 1 y l T Este manipulador es como los primeros dos vínculos del brazo en el ejerci¬ 
cio 3.3. Además suponga que hay fricción viscosa actuando en cada articulación con los 
coeficientes v 1 y v 2 . Escriba la dinámica cartesiana en la trama [3¡, que se ubica en la 
punta del manipulador y tiene la misma orientación que la trama de vínculo {2}. 

6.14 [18] Las siguientes ecuaciones se derivaron para un manipulador 2-DOF RP: 

= lll | L/~ d 2 i^I ~b 2n 2 d~0j "L 2/77 2 ¿^2^1 

COS(0 2 )[/W| (é/j d 2 Ó i) + /Z7 2 (¿^2 "f~ 4i I 
r 9 = m] d 2 0] + >n 2 d 2 — in^d^^ — m 2 d 2 Ó 2 + m 2 (d 2 + l)g sen(0 2 ). 

Algunos de los términos son obviamente incorrectos. Indique los términos incorrectos. 

6.15 [28] Derive las ecuaciones dinámicas para el manipulador RP del ejemplo 6.5, usan¬ 
do el procedimiento de Newton-Euler en vez de la técnica lagrangiana. 

6.16 [25] Derive las ecuaciones de movimiento para el manipulador PR que se muestra en 
la figura 6.10. Ignore la fricción pero incluya la gravedad. (Aquí, X Q va hacia arriba.) 
Los tensores de inercia de los vínculos son diagonales, con los momentos I xxl , I v I zzl 
y 4 * 2 ’ 4 , 2 ’ 4-2' Los centros de la masa para los vínculos se proporcionan mediante 

0 

0 , 

~h_ 

0 “ 

o . 

0_ 

6.17 [40] Los términos relacionados con la velocidad que aparecen en la ecuación dinámi¬ 
ca del manipulador pueden escribirse como un producto matriz-vector; esto es: 

V(&, 0) = V m (0, ©)©, 
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FIGURA 6.10: Manipulador PR del ejercicio 6.16. 


en donde el subíndice m significa “forma matricial”. Demuestre que existe una inte¬ 
resante relación entre la derivada en el tiempo de la matriz de masas del manipulador 
Y VJ-), a saber, 

M(0) = 2V m (0, 0) — S, 
en donde S es una matriz antisimétrica. 

6.18 [15] Proporcione dos propiedades que debería poseer cualquier modelo de fricción ra¬ 
zonable (por ejemplo, el término E(©, ©) en la ecuación (6.114)). 

6.19 [28] Haga el ejercicio 6.5, usando las ecuaciones de Lagrange. 

6.20 [28] Derive las ecuaciones dinámicas del manipulador 2-DOF de la sección 6.7, usan¬ 
do una formulación lagrangiana. 

EJERCICIO DE PROGRAMACIÓN (PARTE 6) 

1. Derive las ecuaciones dinámicas de movimiento para el manipulador de tres vínculos 
(del ejemplo 3.3). Es decir, expanda la sección 6.7 para el caso de tres vínculos. Los si¬ 
guientes valores numéricos describen al manipulador: 

l 1= l 2 = 0.5m, 
m 1 = 4.6Kg, 
m 2 = 2.3Kg, 
m 3 = l.OKg, 
g = 9.8m/s 2 . 


Para los primeros dos vínculos suponemos que toda la masa está concentrada en el ex¬ 
tremo distal del vínculo. Para el vínculo 3 suponemos que el centro de masas está ubi¬ 
cado en el origen de la trama (3); esto es, en el extremo próximo del vínculo. El tensor 
de inercia para el vínculo 3 es 


-' / = 


0.05 0 0 

0 0.1 0 
0 0 0.1 


Kg-m 2 . 
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Los vectores que ubican cada centro de masas en relación con la trama de vínculo res¬ 
pectiva son 

x p Cl =hK 

~ P C 2 = h%2’ 

3 P Ci = O- 

2. Escriba un simulador para el manipulador de tres vínculos. Basta con una simple ru¬ 
tina de integración de Eulcr para realizar la integración numérica (como en la sección 
6.12). Para mantener el código modular, podría ser útil definir la rutina 

Procedure ACTUALIZA!VAR tau: vec3; VAR periodo: real; VAR 
theta, thetapunto: vec3); 

en donde “tau” es el comando de momento de torsión para el manipulador (siempre 
cero para esta asignación), “periodo” es la longitud de tiempo que desea avanzar (en 
segundos) y “theta” y “thetapunto” son el estado del manipulador. Theta y thetapunto 
se actualizan cada “periodo” segundos, cada vez que usted llama a ACTUALIZA. 
Observe que el “periodo” generalmente debe ser más largo que el tamaño del inter¬ 
valo de integración A t utilizado en la integración numérica. Por ejemplo, aunque el 
tamaño de intervalo para la integración numérica podría ser de 0.001 segundos, tal vez 
sea conveniente imprimir la posición y velocidad del manipulador solamente cada 0.1 
segundos. 

Para probar su simulación, haga cero los comandos de momento de torsión de articu¬ 
lación (para todo el tiempo) y realice estas pruebas: 

(a) Establezca la posición inicial del manipulador en 

|(9, e 2 0 3 ] = [-90 0 0], 

Simule por unos cuantos segundos. ¿El movimiento del manipulador es lo que 
usted esperaría? 

(b) Establezca la posición inicial del manipulador en 

|(9, e 2 0 3 ] = [30 30 10], 

Simule por unos cuantos segundos. ¿El movimiento del manipulador es lo que 
usted esperaría? 

(c) Introduzca algo de fricción viscosa en cada articulación del manipulador simu¬ 
lado; esto es, agregue un término a la dinámica de cada articulación en la for¬ 
ma ry.= vO, en donde v = 5.0 newton-metros-segundos para cada articulación. 
Repita la prueba (b) anterior. ¿El movimiento es lo que usted esperaría? 

EJERCICIO MATLAB 6A 

Este ejercicio se enfoca en el análisis de dinámica inversa (en un contexto de control con ve¬ 
locidad resuelta; vea el ejercicio MATLAB 5) para el robot planar 2-DOF 2R. Este robot 
constituye las primeras dos articulaciones R y los primeros dos vínculos móviles del robot pla¬ 
nar 3-DOF 3R. (Vea las figuras 3.6 y 3.7; los parámetros de DH se proporcionan en las pri¬ 
meras dos filas de la figura 3.8.) 

Para el robot planar 2R, calcule los momentos de torsión de articulación requeridos 
(es decir, resuelva el problema de dinámica inversa) para proporcionar el movimiento co¬ 
mandado en cada intervalo, en un esquema de control con velocidad resuelta. Puede usar 
la recursividad numérica de Newton-Euler o las ecuaciones analíticas de los resultados del 
ejercicio 6.2, o ambas. 
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Dadas: L x = l.Om, L 2 = 0.5 m; ambos vínculos son de acero sólido con una densidad 
de masa p = 7806 kg/m 3 ; ambos tienen las dimensiones de anchura y grosor a> — t = 5 cm. 
Se supone que las articulaciones angulares son perfectas, conectando los vínculos precisa¬ 
mente en sus extremos (lo que no es físicamente posible). 

Los ángulos iniciales son © = 



La velocidad cartesiana comandada (constante) es = 0 j^J = 0 j j (m/s). 

Simule el movimiento por 1 segundo, con un intervalo de tiempo de control de 0.01 segun¬ 
dos. Presente cinco trazos (cada conjunto en un gráfico separado): 


1. Los dos ángulos de articulación (grados) 0 = {0, 9 2 } T contra el tiempo. 

2. Las dos velocidades de articulación (rad/s) 0 = ¡0 ( 9 2 } T contra el tiempo. 

3. Las dos aceleraciones de articulación (rad/s 2 ) 0= [6 x 0 2 j 7 contra el tiempo. 

4. Los tres componentes cartesianos de^T, X = {x y <p} T (rad está bien para </>, de mane¬ 
ra que se ajuste) contra el tiempo. 

5. los dos momentos de torsión de articulación de dinámica inversa (Nm) T = jtj r.,} 7 
contra el tiempo. 


Etiquete cuidadosamente (a mano está bien) cada componente en cada trazo. Además, eti¬ 
quete los nombres de los ejes y las unidades. 

Realice la simulación dos veces. La primera vez ignore la gravedad (el plano de mo¬ 
vimiento es normal al efecto de gravedad); la segunda vez considere la gravedad g en la di¬ 
rección negativa de Y. 


EJERCICIO MATLAB 6B 


Este ejercicio se enfoca en la solución de dinámica inversa para el robot 3-DOF, 3R (de las fi¬ 
guras 3.6 y 3.7; los parámetros de DH se proporcionan en la figura 3.8), sólo para una instan¬ 
tánea de movimiento en el tiempo. Se proporcionan los siguientes parámetros de longitud fija: 
L [ — 4, Lj — 3 y L 3 = 2 (m). Para la dinámica también debemos recibir la información sobre 
la masa y el momento de inercia: m l = 20, m 2 = 15, m 3 — 10 (kg), ( I //A = 0.5, < I //1 — 0.2 y 
c / zz3 = 0.1 ( kgm 2 ). Suponga que el CG de cada vínculo está en su centro geométrico. Ade¬ 
más suponga que la gravedad actúa en la dirección -Y en el plano de movimiento. Para este 
ejercicio ignore la dinámica de los actuadores y el engranaje de las articulaciones. 


a) Escriba un programa en MATLAB para implementar la solución de dinámica inver¬ 
sa recursiva de Newton-Euler (es decir, dado el movimiento comandado, calcule los 
momentos de torsión de articulación de control requeridos) para la siguiente instan¬ 
tánea de movimiento en el tiempo: 


0 = 



0 = 



(rad/s) 0 = I 0 2 1 = 
& 


(rad/s 2 ) 


b) Compruebe sus resultados en ( a ) mediante la Caja de Herramientas de Robótica 
MATLAB de Corke. Pruebe las funciones rne() y gravload(). 


EJERCICIO MATLAB 6C 

Este ejercicio se enfoca en la solución de dinámica directa para el robot planar 3-DOF, 3R 
(parámetros del ejercicio MATLAB 6B) para el movimiento sobre el tiempo. En este caso 
ignore la gravedad (es decir, suponga que la gravedad actúa en una dirección normal al plano 
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de movimiento). Use la Caja de Herramientas de Robótica MATLAB de Corke para resol¬ 
ver el problema de dinámica directa (es decir, dados los momentos de torsión de control co¬ 
mandados, calcule el movimiento resultante del robot) para los siguientes momentos de torsión 
de articulación constantes y los ángulos de articulación iniciales dados, y las proporciones de 
articulación iniciales dadas: 



(Nm, constante) 


©o = 



í¿io 

©o = | Ó 20 

1^30. 


°) 

0 [ (rad/s) 

°l 


[-60° 
I 90° 
l 30° 


Realice esta simulación por 4 segundos. Pruebe con la función fdyn(). 

Presente dos trazos para el movimiento resultante del robot (cada conjunto en un grá¬ 
fico separado): 


1. Los tres ángulos de articulación (grados) 0 = 0 2 0 3 } r contra el tiempo. 

2. Las tres velocidades de articulación (rad/s) 0 = {9 1 0 2 9 3 } T contra el tiempo. 


Etiquete cuidadosamente (a mano está bien) cada componente en cada trazo. Además, eti¬ 
quete los nombres de los ejes y las unidades. 
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7.1 INTRODUCCIÓN 

7.2 CONSIDERACIONES GENERALES SOBRE LA DESCRIPCIÓN Y GENERACIÓN DE RUTAS 

7.3 ESQUEMAS EN EL ESPACIO DE ARTICULACIÓN 

7.4 ESQUEMAS EN EL ESPACIO CARTESIANO 

7.5 PROBLEMAS GEOMÉTRICOS CON LAS RUTAS CARTESIANAS 

7.6 GENERACIÓN DE RUTAS EN TIEMPO DE EJECUCIÓN 

7.7 DESCRIPCIÓN DE RUTAS CON UN LENGUAJE DE PROGRAMACIÓN DE ROBOTS 

7.8 PLANEACIÓN DE RUTAS CUANDO SE USA EL MODELO DINÁMICO 

7.9 PLANEACIÓN DE RUTAS SIN COLISIONES 


7.1 INTRODUCCIÓN 

En ese capítulo nos enfocaremos en los métodos para calcular una trayectoria que des¬ 
criba el movimiento deseado de un manipulador en espacio multidimensional. Aquí, 
trayectoria se refiere a un historial en el tiempo de la posición, la velocidad y la acele¬ 
ración para cada grado de libertad. 

Esto incluye el problema de interfaz humana de cómo deseamos especificar una 
trayectoria o ruta a través del espacio. Para facilitar la descripción del movimiento de 
un manipulador de un sistema de robot, no se le debería requerir al usuario que escriba 
funciones complicadas de espacio y tiempo para especificar la tarea. Lo que debemos 
hacer es proporcionar la capacidad de especificar trayectorias con simples descripcio¬ 
nes del movimiento deseado y dejar que el sistema desarrolle los detalles. Por ejemplo, 
el usuario podría especificar nada más que la posición y la orientación de destino de¬ 
seadas del efector final y dejar que el sistema decida la forma exacta de la ruta para lle¬ 
gar ahí, la duración, el perfil de velocidad y otros detalles. 

También nos interesa la manera en que las trayectorias se representan en la com¬ 
putadora una vez planeadas. Finalmente, está el problema de calcular la trayectoria a 
partir de la representación interna (o generar la trayectoria). La generación ocurre en 
tiempo de ejecución ; en el caso más general se calcula la posición, la velocidad y la ace¬ 
leración. Estas trayectorias se determinan en computadoras digitales, por lo que los 
puntos de la trayectoria se calculan con cierta frecuencia, a la cual se le llama frecuen¬ 
cia de actualización de ruta. En sistemas manipuladores estándar esta frecuencia se en¬ 
cuentra entre 60 y 2000 Hz. 

7.2 CONSIDERACIONES GENERALES SOBRE LA DESCRIPCIÓN Y GENERACIÓN DE RUTAS 

En su mayor parte, consideraremos los movimientos de un manipulador como los 
movimientos de la trama herramienta [Tj relativos a la trama estación ¡Sj, que es la 




202 Capítulo 7 


Generación de trayectorias 


forma en la que pensaría un usuario eventual del sistema, por lo que diseñar un sis¬ 
tema de descripción y generación de rutas en estos términos produciría algunas ven¬ 
tajas importantes. 

Cuando especificamos rutas como movimientos de la trama herramienta relativos 
a la trama estación, desacoplamos la descripción de movimiento de un robot, un efec- 
tor final o unas piezas de trabajo específicas. Esto produce cierta modularidad y permi¬ 
te que se utilice la misma descripción de ruta con otro manipulador, o con el mismo, 
pero con un tamaño de herramienta distinto. Además, podemos especificar y planear 
los movimientos en relación con una estación de trabajo móvil (tal vez una banda trans¬ 
portadora) al planear los movimientos relativos a la trama estación como siempre y en 
tiempo de ejecución hacer que la definición de ¡5) cambie con el tiempo. 

Como se muestra en la figura 7.1, el problema básico es mover el manipulador 
desde una posición inicial hasta cierta posición final deseada; esto es, deseamos mover 
la trama herramienta desde su valor actual, !7’ jn¡c ¡ al ¡, hasta un valor final deseado, {T f¡n;i| ¡. 
Observe que, en general, este movimiento implica tanto un cambio en la orientación 
como en la posición de la herramienta relativa a la estación. 

Algunas veces es necesario especificar el movimiento con mucho más detalle que 
el necesario para sólo declarar la configuración final deseada. Una manera de incluir 
más detalle en una descripción de ruta es proporcionar una secuencia de puntos vía de¬ 
seados (puntos intermedios entre las posiciones inicial y final). Por lo tanto, al completar 
el movimiento la trama herramienta debe pasar a través de un conjunto de posiciones 
y orientaciones intermedias, según lo descrito por los puntos vía. Cada uno de estos 
puntos vía es en realidad una trama que especifica tanto la posición como la orienta¬ 
ción de la herramienta en forma relativa a la estación. El nombre puntos ruta incluye 
todos los puntos vía, junto con los puntos inicial y final. Recuerde que aunque utiliza¬ 
mos generalmente el término “puntos”, estamos hablando en realidad de tramas que 
proporcionan la posición y la orientación. Junto con estas restricciones espaciales del 
movimiento, tal vez el usuario también desee especificar atributos temporales del mo¬ 
vimiento. Por ejemplo, el tiempo transcurrido entre los puntos vía podría especificarse 
en la descripción de la ruta. 

Generalmente es conveniente que el movimiento del manipulador sea uniforme. 
Aquí definiremos una función uniforme como una función que es continua y cuya pri¬ 
mera derivada es continua. Algunas veces también es conveniente una segunda derivada 




FIGURA 7.1: Al ejecutar una trayectoria, un manipulador se mueve desde su posición 
inicial hasta una posición de destino deseada de manera uniforme. 
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continua. Los movimientos bruscos y torpes tienden a producir un mayor desgaste en 
el mecanismo y producen vibraciones al excitar las resonancias en el manipulador. Pa¬ 
ra garantizar rutas uniformes primero debemos colocar cierto tipo de restricciones en 
las características espaciales y temporales de la ruta entre los puntos vía. 

En este momento existen muchas elecciones que pueden tomarse y, por consecuencia, 
hay una gran variedad de formas en que pueden especificarse y planearse las rutas. Puede 
usar cualquier función uniforme de tiempo que pase a través de los puntos vía para especi¬ 
ficar la forma exacta de la ruta. En este capítulo veremos un par de elecciones simples para 
estas funciones. Si desea conocer otros métodos consulte las referencias [1,2] y [13-16]. 

7.3 ESQUEMAS EN EL ESPACIO DE ARTICULACIÓN 

En esta sección consideraremos métodos de generación de rutas en los que las formas 
de éstas (en espacio y en tiempo) se describen en términos de funciones de ángulos de 
articulación. 

Cada punto de la ruta se especifica generalmente en términos de una posición y 
una orientación deseadas de la trama herramienta ¡ 7) relativa a la trama estación [5]. 
Cada uno de estos puntos vía se “convierte” en un conjunto de ángulos de articulación 
deseados mediante la aplicación de la cinemática inversa. Después se encuentra una 
función uniforme para cada una de las n articulaciones que pasan a través de los pun¬ 
tos vía y que terminan en el punto de destino. El tiempo requerido por segmento es el 
mismo para cada articulación, de manera que todas las articulaciones llegarán al punto 
vía al mismo tiempo, produciendo por consecuencia la posición cartesiana deseada de { T ) 
en cada punto vía. Aparte de especificar la misma duración para cada articulación, la 
determinación de la función de ángulo de articulación deseada para una articulación 
específica no depende de las funciones para las demás articulaciones. 

Por ende, los esquemas de espacio de articulación logran la posición y la orienta¬ 
ción deseadas en los puntos vía. En el trayecto entre los puntos vía, la forma de la ru¬ 
ta, aunque es considerablemente simple en el espacio de articulación, es compleja si se le 
describe en espacio cartesiano. Los esquemas en el espacio de articulación son general¬ 
mente los más fáciles de calcular y, como no hay una correspondencia continua entre el 
espacio de articulación y el espacio cartesiano, esencialmente no hay ningún problema 
con las singularidades del mecanismo. 

Polinomios cúbicos 

Considere el problema de mover la herramienta desde su posición inicial hasta una po¬ 
sición de destino en cierta cantidad de tiempo. La cinemática inversa permite calcular 
el conjunto de ángulos de articulación que corresponden a la posición y la orientación de 
destino. La posición inicial del manipulador también se conoce en la forma de un con¬ 
junto de ángulos de articulación. Lo que se requiere es una función para cada articula¬ 
ción, cuyo valor en t Q sea la posición inicial de la articulación y cuyo valor en í, sea la 
posición deseada de esa articulación. Como se muestra en la figura 7.2, hay muchas fun¬ 
ciones uniformes 0{t) que podrían usarse para interpolar el valor de las articulaciones. 

Para crear un solo movimiento uniforme son evidentes cuando menos cuatro res¬ 
tricciones sobre 6{t). Dos de esas restricciones sobre el valor de la función se deben a 
la selección de valores inicial y final: 


0 ( 0 ) = 0Q, 

9(tf) = Qf. 


(7.1) 
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FIGURA 7.2: Varias formas posibles de ruta para una sola articulación. 


Las otras dos restricciones son que la función debe ser continua en velocidad, lo cual 
en este caso significa que las velocidades inicial y final deben ser cero: 


0 ( 0 ) = 0 , 

é(t f ) = 0. (7.2) 

Estas cuatro restricciones pueden satisfacerse mediante un polinomio de por lo 
menos tercer grado. (Un polinomio cúbico tiene cuatro coeficientes, por lo que puede 
usarse para satisfacer las cuatro restricciones dadas por las ecuaciones (7.1) y (7.2)). Es¬ 
tas restricciones determinan de manera única una ecuación cúbica específica. Este tipo 
de ecuaciones tiene la forma 


9 "3 

0(t ) = £Zq -f- Cl^t -}- #2^ “h , 


(7.3) 


de manera que la velocidad y la aceleración de la articulación a lo largo de esta ruta son 
claramente 


9(t) = a 1 + 2a 2 t + 3 u 3 í 2 , 

0(í) = 2 a 2 + 6 a 3 t. (7.4) 

Si combinamos las ecuaciones (7.3) y (7.4) con las cuatro restricciones deseadas se pro¬ 
ducen cuatro ecuaciones con cuatro incógnitas: 


°0 — fl 0 ’ 

9 y = d" 0.\tf + í?2d~ 

0 = « 1; (7-5) 

0 = ci 3 + 2a 2 t f -p 3a 3 í . 

Resolviendo estas ecuaciones para las cl obtenemos 


«0 — % 
«i = 0, 
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a 2 = ^f-e 0 ), (7.7) 

f 

«3 = --J (0 / _0 o)- 
/ 

Con la ecuación (7.6) podemos calcular el polinomio cúbico que conecta cualquier po¬ 
sición de ángulo de articulación inicial con cualquier posición final deseada. Esta solu¬ 
ción es para el caso en el que la articulación inicia y termina con una velocidad de cero. 


EJEMPLO 7.1 

Un robot de un solo vínculo con una articulación giratoria está sin movimiento a 0 = 15 
grados. Se desea mover la articulación de manera uniforme a 0 = 75 grados en 3 segun¬ 
dos. Encuentre los coeficientes de una ecuación cúbica que realice este movimiento y 
lleve el manipulador a su destino. Trace la posición, la velocidad y la aceleración de la ar¬ 
ticulación como una función del tiempo. 

Mediante la ecuación (7.6) encontramos que 

«o = 15.0, 

¿q = 0.0, 

a 2 = 20.0, (7.7) 

a 3 = -4.44. 

Con las ecuaciones (7.3) y (7.4) obtenemos 

0(0 = 15.0 + 20.0f 2 — 4.44r 3 , 

0(0 = 40.0r - 13.33í 2 , (7.8) 

0(0 = 40.0 — 26.66r. 

La figura 7.3 muestra las funciones de posición, velocidad y aceleración para este mo¬ 
vimiento, muestreadas a 40 Hz. Observe que el perfil de velocidad para cualquier fun¬ 
ción es una parábola y que el perfil de aceleración es lineal. 


Polinomios cúbicos para una ruta con puntos vía 

Hasta ahora hemos considerado los movimientos descritos por una duración deseada y 
un punto de destino final; en general deseamos permitir la especificación de rutas que 
incluyan puntos vía intermedios. Si el manipulador se va a detener en cada punto vía, 
podemos usar la solución cúbica de la sección 7.3. 

Por lo común deseamos poder pasar a través de un punto vía sin detenernos, por 
lo cual necesitamos generalizar la forma en que ajustaremos ecuaciones cúbicas a las 
restricciones de las rutas. 

Como en el caso de un solo punto de destino, cada punto vía se especifica gene¬ 
ralmente en términos de una posición y una orientación deseadas de la trama herra¬ 
mienta relativa a la trama estación. Cada uno de estos puntos vía se “convierte” en un 
conjunto de ángulos de articulación deseados mediante la aplicación de cinemática in¬ 
versa. Después consideramos el problema de calcular ecuaciones cúbicas que conecten 
entre sí los valores de los puntos vía para cada articulación de una manera uniforme. 
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FIGURA 7.3: Perfiles de posición, velocidad y aceleración para un solo segmento cúbi¬ 
co que inicia y termina inmóvil (velocidad cero). 


Si se conocen las velocidades deseadas de las articulaciones en los puntos vía, en¬ 
tonces podemos construir polinomios cúbicos como antes; sin embargo, ahora las res¬ 
tricciones de velocidad en cada extremo no son iguales a cero, sino que tienen cierta 
velocidad conocida. Las restricciones de la ecuación (7.3) se vuelven 


6(0) = e 0 , 

é(tf) = é f . 


(7.9) 
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Las cuatro ecuaciones que describen este polinomio cúbico general son 


6 0 — a 0 , 

6/ = ÜQ -\- ci\tf "b 

6 0 = ci 1 , 

Ój: = a l "I - 2^2? j- ~\~ 3. 


(7.10) 


Al resolver estas ecuaciones para las a ¡ obtenemos 



o)-- 



(7.11) 


7 7 


2 


1 . 


d 3 — — 0 q) + (0/ + ${))■ 


7 7 


Utilizando la ecuación (7.11) podemos calcular el polinomio cúbico que conecta las po¬ 
siciones inicial y final con las velocidades inicial y final. 

Si tenemos las velocidades de articulación deseadas en cada punto vía, entonces 
simplemente aplicamos la ecuación (7.11) a cada segmento para encontrar los polinomios 
cúbicos requeridos. Existen varias formas en las que podría especificarse la velocidad 
deseada en los puntos vía: 

1. El usuario especifica la velocidad deseada en cada punto vía en términos de velo¬ 
cidades cartesianas lineal y angular de la trama herramienta en ese instante. 

2. El sistema selecciona automáticamente las velocidades en los puntos vía median¬ 
te la aplicación de una heurística adecuada, ya sea en espacio cartesiano o de ar¬ 
ticulación. 

3. El sistema selecciona de manera automática las velocidades en los puntos vía de 
tal forma que la aceleración en los puntos vía sea continua. 

En la primera opción, las velocidades cartesianas deseadas en los puntos vía se 
“asignan” a las proporciones de articulación deseadas, por medio del jacobiano inver¬ 
so del manipulador evaluado en el punto vía. Si el manipulador se encuentra en un punto 
singular en un punto vía específico, entonces el usuario no puede asignar una velocidad 
arbitraria en este punto. El esquema de generación de rutas tiene la útil capacidad de 
cumplir con una velocidad deseada que el usuario especifique, pero sería una carga re¬ 
querir que el usuario siempre haga estas especificaciones. Por lo tanto, un sistema con¬ 
veniente debería incluir la opción 2 o la 3 (o ambas). 

En la opción 2 el sistema selecciona de manera automática velocidades interme¬ 
dias razonables, por medio de algún tipo de heurística. Considere la ruta especificada 
por los puntos vía que se muestran para una articulación 6 en la figura 7.4. 

En esta figura hemos optado por la razonable elección de velocidades de articu¬ 
lación en los puntos vía, según lo indicado con pequeños segmentos lineales que repre¬ 
sentan tangentes a la curva en cada punto vía. Esta elección es el resultado de aplicar 
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h ¡A { B <C <D 

FIGURA 7.4: Puntos vía con velocidades deseadas en los puntos indicados por las tangentes. 


una heurística simple en términos conceptuales y computacionales. Imagine los puntos 
vía conectados con segmentos de líneas rectas: si cambia de signo la pendiente de estas 
líneas en el punto vía, elija la velocidad cero; si la pendiente de estas líneas no cambia 
de signo, seleccione el promedio de las dos pendientes como velocidad del punto vía. 
De esta forma el sistema puede seleccionar la velocidad en cada punto con sólo espe¬ 
cificar los puntos vía deseados. 

En la opción 3 el sistema selecciona las velocidades de forma tal que la acelera¬ 
ción sea continua en el punto vía; para ello se necesita un nuevo enfoque. En este tipo 
de trazador o “ spline 5,1 sustituimos las dos restricciones de velocidad en la conexión de 
dos polinomios cúbicos con las dos restricciones que especifican que la velocidad y la 
aceleración deben ser continuas. 


EJEMPLO 7.2 

Resuelva para los coeficientes de dos polinomios cúbicos que están conectados en un 
trazador de dos segmentos con aceleración continua en el punto vía intermedio. El án¬ 
gulo inicial es 0 O , el punto vía es 6 V , y el punto de destino es 6 . 

El primer polinomio cúbico es 

ú(t) = £qo 4- a 11r A^t 4- a^í j (7.12) 

y el segundo es 

d(í) = A 2 Q 4“ @21^ ~t~ 4“ ^23^• (7.13) 

Cada polinomio cúbico se evaluará sobre un intervalo que empieza en t = 0 y termina 
en / = tp en donde i = 1 o i = 2. 

Las restricciones que queremos hacer valer son 

% ~ a 10’ 

= fl 10 + a ll í /l + a 12 f /l + fl 13 
= fl 20’ 

6g = a 20 + a 2\ t f2 + a 22 {2 f2 + a 23 t?, f2' (7-14) 

0 = An, 


1 Para nuestro uso, el término “trazador” (en inglés, spline) significa simplemente una función del tiempo. 
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la séptima igualdad de la ecuación 7.14 debe ser: 

0 = «21 + 2 « 22 f /2 + ^« 23 ^ 2 ’ 

«H + 2«12Í/1 + 3«i3Í^ 1 = «21 > 

2«12 + 6 « 13 í ^ 1 = 2 fl 22 . 

Estas restricciones especifican un problema de ecuaciones lineales en el cual hay 
ocho ecuaciones y ocho variables desconocidas. Al resolver para el caso f, = f ~ = t^, 
obtenemos 


«10 

«n 

«12 

«13 

«20 

«21 

«22 

«23 


120, - 36 g - 99 0 
4 

—86 v + 39g + 50q 
4f3 


30 g - 39 0 
4t f 

— 12& v + 66 g + 69q 
41 2 

8 e v - 5d g - 3 6 0 
4 tj 


(7.15) 


Para el caso general en el que se involucran n segmentos cúbicos, las ecuaciones 
que surgen por insistir en una aceleración continua en los puntos vía pueden formular¬ 
se en forma matricial, la cual se resuelve para calcular las velocidades en los puntos vía. 
La matriz resulta ser tridiagonal y se resuelve fácilmente [4], 

Polinomios de mayor orden 

Algunas veces se utilizan polinomios de mayor orden para los segmentos de ruta. Por 
ejemplo, si deseamos especificar la posición, la velocidad y la aceleración al inicio y al 
final de cada segmento de ruta, se requiere un polinomio de quinto grado, a saber, 

ú(í) = «q 4“ «^í 4r « 2 ? 4“ « 3 ? 4- «¿p 4* « 5 ? , 
en donde las restricciones se dan así: 

6 0 = a 0 , 

0f —■ «q 4- «E^- 4" « 2 ^y- « 3 ty- 4- « 4 ?^. 4" « 5 ^., 


(7.16) 
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Ó Q — a 1 , 

6f = a 1 + 2 a 2 tf + 3 a 3 t 2 + 4 a 4 t 2 + 5a 5 t* (7.17) 

0 O == 2¿z 2 , 

¿i^ = 2u 2 + 6 a 3 fy + 12 a 4 í^. + 20a 5 t 2 . 


Estas restricciones especifican un conjunto lineal de seis ecuaciones con seis variables 
desconocidas cuya solución es 


«o — % 

«i = % 


a 2 


«3 


fl 4 


fl 5 


% 
2 ’ 


200 f - 200 O - (80y + 120 o )í f - (30 o - G f )t 2 


2 '? 


3O0 o - 3O0 / + (140 f + 160 o )íy + (36» 0 - 20})^ 


2t f 


12 0 f - 120 O - (60^ + 60 o )t f - (0 O - 0 f )t 2 f 


2t f 


(7.18) 


Existen varios algoritmos disponibles para calcular funciones uniformes (polino¬ 
mios o de cualquier otro tipo) que pasen a través de un conjunto dado de puntos de 
datos [3, 4]. No obstante, este tema queda más allá del alcance de este libro. 


Función lineal con mezclas parabólicas 

Otra opción de forma de ruta es la lineal. Es decir, simplemente interpolamos lineal¬ 
mente para realizar un movimiento desde la posición de articulación actual hasta la po¬ 
sición final, como se muestra en la figura 7.5. Recuerde que aunque el movimiento de 
cada articulación en este esquema es lineal el efector final no se mueve en general en 
una línea recta en el espacio. 



FIGURA 7.5: Interpolación lineal que requiere de una aceleración infinita. 
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Sin embargo, la interpolación lineal directa haría que la velocidad fuera disconti¬ 
nua al inicio y al final del movimiento. Para crear una ruta uniforme con posición y ve¬ 
locidad continuas, empezamos con la función lineal pero agregamos una región de 
mezcla parabólica en cada punto de la ruta. 

Durante la porción de mezcla de la trayectoria se utiliza una aceleración cons¬ 
tante para cambiar la velocidad de manera uniforme. La figura 7.6 muestra una ruta 
simple que se construye en esta forma. La función lineal y las dos funciones parabó¬ 
licas se “empalman” de manera que toda la ruta completa sea continua en posición y 
en velocidad. 

Para poder construir este segmento individual supongamos que las mezclas para¬ 
bólicas tienen la misma duración; por lo tanto, se utiliza la misma aceleración constan¬ 
te durante ambas mezclas. Como se indica en la figura 7.7, hay muchas soluciones para 
este problema, pero debemos tener en cuenta que la respuesta es siempre simétrica so¬ 
bre el punto intermedio en el tiempo, representado por t h , y sobre el punto intermedio 
en la posición, representado por 9 h . La velocidad al final de la región de mezcla debe 
ser igual a la velocidad de la sección lineal, por lo que tenemos que 



(7.19) 


en donde 9 b es el valor de 9 al final de la región de mezcla y 9 es la aceleración que ac¬ 
túa durante la región de mezcla. El valor de 9 b se obtiene mediante 


~ @0 + Y^y 


(7.20) 


e 



to h 


FIGURA 7.6: Segmento lineal con mezclas parabólicas. 


e 



FIGURA 7.7: Segmento lineal con mezclas parabólicas. 
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Al combinar las ecuaciones (7.19) y (7.20) y hacer que t = 2t h , obtenemos 


et¡ - étt b + (9 f - e 0 ) = o, 


(7.21) 


en donde t es la duración deseada del movimiento. Dado cualquier valor para 6), 9 o y t, 
podemos seguir cualquiera de las rutas dadas con base en las elecciones de 9 y t, que sa¬ 
tisfagan la ecuación (7.21). En general se elige una aceleración 9 y se resuelve la ecuación 
(7.21) para obtener el valor correspondiente de t f) . La aceleración que se elija deberá ser 
lo suficiente alta o de lo contrario no existirá una solución. Al resolver la ecuación (7.21) 
para t b en términos de la aceleración y otros parámetros conocidos, obtenemos 


t y¿' 2 r 2 - 40(0, - 6 0 ) 
2 26? 


(7.22) 


La restricción sobre la aceleración utilizada en la mezcla es 


9 > 


4 (6 f — 9q) 

~T 2 


(7.23) 


Cuando ocurre la igualdad en la ecuación (7.23) la porción lineal se reduce a una lon¬ 
gitud cero y la ruta está compuesta de dos mezclas que se conectan con pendiente equi¬ 
valente. A medida que la aceleración utilizada se hace cada vez más grande, la longitud 
de la región de mezcla se hace cada vez más corta. En el límite, con una aceleración in¬ 
finita, regresamos al caso simple de interpolación lineal. 


EJEMPLO 7.3 

Para la misma ruta de un solo segmento descrita en el ejemplo 7.1, muestre dos ejem¬ 
plos de una ruta lineal con mezclas parabólicas. 

La figura 7.8(a) muestra una posibilidad en la que se eligió un valor de 9 en ex¬ 
tremo alto. En este caso aceleramos rápidamente, después seguimos a una velocidad 
constante y luego desaceleramos. La figura 7.8(b) muestra una trayectoria en la que la 
aceleración se mantiene a un valor considerablemente bajo, por lo que la sección lineal 
casi desaparece. 


Función lineal con mezclas parabólicas para una ruta con puntos vía 

Ahora consideremos las rutas lineales con mezclas parabólicas para el caso en el que ha¬ 
ya un número arbitrario de puntos vía especificados. La figura 7.9 muestra un conjunto 
de puntos vía de espacio de articulación para cierta articulación 9. Las funciones lineales 
conectan los puntos vía y se agregan regiones de mezcla parabólica alrededor de éstos. 

Utilizaremos la siguiente notación: considere tres puntos de ruta adyacentes, a los 
que llamaremos puntos j, k y /. La duración de la región de mezcla en el punto de ruta k 
es t k . La duración de la porción lineal entre los puntos j y k es t-,. La duración total del 
segmento que conecta los puntos j y k es t djk . La velocidad durante la porción lineal es 9- k 
y la aceleración durante la mezcla en el punto j es 9 , Vea un ejemplo en la figura 7.9. 

Al igual que con el caso de un solo segmento, existen muchas soluciones posibles, 
dependiendo del valor de aceleración usado en cada mezcla. Dados todos los puntos de 
ruta 9 k , las duraciones deseadas t d - k y la magnitud de la aceleración a usar en cada punto 
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Posición 





Velocidad 


Velocidad 


36 - 
24 - 
12 - 
0 - 
-12 - 
-24 - 
-36 - 


Grados/seg 2 


25 

20 

15 

10 

5 


Grados/seg 2 



r 0 

-5 

-10 




-15 




-20 




Segundos ”25 

=i_i 

1 1 


.6 1.2 1.8 2.4 3.0 

Aceleración 

(a) 


.6 1.2 1.8 2.4 

Aceleración 

(b) 


Segundos 


3.0 


FIGURA 7.8: Perfiles de posición, velocidad y aceleración para la interpolación lineal con 
mezclas parabólicas. El conjunto de curvas de la izquierda está basado en una mayor ace¬ 
leración durante las mezclas que la utilizada del lado derecho. 


de ruta 1 6 k \, podemos calcular los tiempos de mezcla t k . Para los puntos de la ruta inte¬ 
rior, esto se obtiene fácilmente de las ecuaciones 


Ójk 

h 


t jk 


t djk 


SGN( 0 u -d jk )\e k \ 

éu-ójk 
h ' 


tj; 


djk 2 J 


~t: ~ ~tu. 


(7.24) 
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FIGURA 7.9: Ruta lineal de varios segmentos, con mezclas. 


Los segmentos primero y último deben manejarse de manera ligeramente distinta, ya 
que debe contarse toda una región de mezcla en un extremo del segmento en la dura¬ 
ción de tiempo total del segmento. 

En el primer segmento resolvemos para t 1 igualando dos expresiones para la ve¬ 
locidad durante la fase lineal del segmento: 

0 7 - 0i 

2 \ =0ih- ( 725 ) 

? 12 ~ 2 ? 1 

Ésta puede resolverse para t v el tiempo de mezcla en el punto inicial; después 0 1? y f |2 
se calculan fácilmente: 


e l = SGN(0 2 -6{) 16»! |, 


h = 


t 12 ~ 



t dl2 ~ ih 

1 

t dl2 ~ h ~ 2 Í2 ' 


2(0 2 - 0!) 
h 


( 7 . 26 ) 


De igual forma, para el último segmento (el que conecta los puntos n — 1 y n) te¬ 
nemos que 


— 1 q t 

- — - 0/7Él 

t d(n—l)n ~ 2É 

lo cual nos lleva a la solución 

0 n = SGN(0 n _ 1 -e n ) \e n \. 


t n ~ t d(n-l)n 


d(n—Y)n 


2(0„ ~ 0„_i) 

0 ' 


( 7 . 27 ) 
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t(n— 1 )n 


°n ~ 0„-l 

t _ 1 1 ’ 
í d(n-l)n 2 ‘n 

1 

^d(n — \)n ^n—1' 


(7.28) 


Con las ecuaciones (7.24) a (7.28) podemos despejar los tiempos de mezcla y las 
velocidades para una ruta de varios segmentos. Por lo regular el usuario especifica sólo 
los puntos vía y la duración deseada de los segmentos. En este caso el sistema utiliza 
valores predeterminados para la aceleración de cada articulación. Algunas veces, para 
simplificar las cosas al usuario, el sistema calcula las duraciones con base en las veloci¬ 
dades predeterminadas. En todas las mezclas debe usarse la aceleración necesaria pa¬ 
ra que haya suficiente tiempo para entrar en la porción lineal del segmento antes de 
que empiece la siguiente región de mezcla. 


EJEMPLO 7.4 

La trayectoria de una articulación en particular se especifica de la siguiente manera: los 
puntos de ruta en grados: 10, 35, 25, 10. La duración de estos tres segmentos debe ser 

2, 1, 3 segundos, respectivamente. La magnitud de la aceleración predeterminada que 
se va a utilizar en todos los puntos de mezcla es de 50 grados/seg * 2 . Calcule las velocida¬ 
des, tiempos de mezcla y tiempos lineales de todos los segmentos. 

Para el primer segmento aplicamos la ecuación (7.26) para encontrar 

<9, = 50.0. (7.29) 

Si aplicamos la ecuación (7.26) para calcular el tiempo de mezcla en el punto inicial, 
obtenemos 


n = 2 - 


2(35 - 10) 

4 - 500 ^ = °- 27 ' 


La velocidad 0 n se calcula de la ecuación (7.26) así: 


J 12 ~ 


35 - 10 
2 - 0.5(0.27) 


= 13.50. 


La velocidad 0 23 se calcula de la ecuación (7.24) así: 

25 - 35 

0 23 = —— = - 10 . 0 . 

A continuación aplicamos la ecuación (7.24) para encontrar 

e 2 = -50.0. 

Después, con la ecuación (7.24) se calcula t 2 y obtenemos 


ti — 


-10.0-13.50 


-50.0 


= 0.47. 


(7.30) 

(7.31) 

(7.32) 

(7.33) 

(7.34) 


La longitud de la porción lineal del segmento 1 se calcula de la ecuación (7.26): 

t l2 = 2-0.27- \ (0.47) = 1.50. (7.35) 


Ahora, de la ecuación (7.29) tenemos que 

0 4 = 50.0. 


(7.36) 
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Entonces, para el último segmento con la ecuación (7.28) calculamos t 4 : 


, 2(10-25) 

t *= 3 -r +A wr 1=oA ° 2 - 

La velocidad ¿ 34 se calcula de la ecuación (7.28) así: 

10 - 25 

= ^50 = - 5 - 10 - 

A continuación se utiliza la ecuación (7.24) para obtener 


6*3 = 50.0. 


Entonces se calcula f, de la ecuación (7.24): 

-5.10- (-10.0) 


0.098. 


Por último, de la ecuación (7.24) calculamos 


t 23 = 1 - | (0.47) - \ (0.098) = 0.716, 
r 34 = 3 - i (0.098) - 0.012 = 2.849. 


(7.37) 

(7.38) 

(7.39) 

(7.40) 

(7.41) 

(7.42) 


Los resultados de estos cálculos constituyen un “plan” para la trayectoria. En tiempo 
de ejecución de generador de rutas utilizaría estos números para calcular los valores de 
9, 9 y 9 a la frecuencia de actualización de la ruta. 


En estos trazadores de mezcla parabólica lineal hay que tener en cuenta que en 
realidad no se llega a los puntos vía, a menos que el manipulador se detenga. A menudo, 
cuando la capacidad de aceleración es lo suficiente alta, las rutas se acercarán considera¬ 
blemente al punto vía deseado. Si en realidad queremos pasar a través de un punto, lle¬ 
gando a un alto, el punto vía simplemente se repite en la especificación de la ruta. 

Si el usuario desea especificar que el manipulador pasa exactamente a través de 
un punto vía sin detenerse, puede acomodarse esta especificación con la misma formu¬ 
lación que antes, pero con la siguiente adición: el sistema sustituye automáticamente el 
punto vía a través del cual deseamos que pase el manipulador con dos seudopuntos vía: 
uno en cada lado del original (como en la figura 7.10). Entonces, la generación de ru¬ 
tas se lleva a cabo igual que antes. El punto vía original ahora se encontrará en la re¬ 
gión lineal de la ruta que conecta los dos seudopuntos vía. Además de solicitar que el 
manipulador pase exactamente a través de un punto vía, el usuario puede solicitar tam¬ 
bién que pase con cierta velocidad. Si el usuario no especifica esta velocidad, el siste¬ 
ma la elegirá por medio de una heurística apropiada. Podría usarse el término punto de 
paso (en vez de punto vía) para especificar un punto de la ruta por el cual forzamos al 
manipulador para que pase exactamente a través suyo. 

7.4 ESQUEMAS EN EL ESPACIO CARTESIANO 

Como se mencionó en la sección 7.3, las rutas que se calculan en espacio de articulación 
pueden asegurar que se llegue a los puntos vía y los puntos de destino, incluso cuando 
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FIGURA 7.10: Uso de seudopuntos vía para crear un punto “de paso”. 

estos puntos de ruta se hayan especificado mediante tramas cartesianas. Sin embargo, 
la forma espacial de la ruta tomada por el efector final no es una línea recta a través del 
espacio, sino una forma complicada que depende de un comportamiento cinemático es¬ 
pecífico del manipulador que se esté utilizando. En esta sección consideraremos méto¬ 
dos de generación de rutas en los cuales las formas de las rutas se describen en términos 
de funciones que calculan la posición y la orientación cartesianas como funciones del 
tiempo; de esta manera podemos también especificar la forma espacial de la ruta entre 
los puntos de ruta. La forma más común de una ruta es una línea recta, pero podrían 
usarse rutas de forma circular, sinusoidal u otro tipo. 

Cada punto de una ruta se especifica generalmente en términos de una posición y 
una orientación deseadas de la trama herramienta, relativas a la trama estación. En es¬ 
quemas de generación de rutas con base cartesiana, las funciones que se “empalman” 
entre sí, para formar una trayectoria son funciones del tiempo que representan variables 
cartesianas. Estas rutas pueden ser planeadas directamente desde la definición de pun¬ 
tos de ruta del usuario, que son especificaciones de ¡7] respecto a {.S'¡. sin necesidad de 
realizar primero la cinemática inversa. No obstante, los esquemas cartesianos requieren 
de un mayor poder de cómputo para ejecutarse, ya que en tiempo de ejecución debe re¬ 
solverse la cinemática inversa a la frecuencia de actualización de ruta; esto es, una vez 
que se genera la ruta en espacio cartesiano, como último paso debe realizarse el cálculo 
de la cinemática inversa para calcular los ángulos de articulación deseados. 

La comunidad de robótica industrial e investigación ha propuesto varios esque¬ 
mas para generar rutas cartesianas [1, 2]. En la siguiente sección presentaremos un 
esquema como ejemplo. En este esquema podremos usar el mismo trazador lineal- 
parabólico que desarrollamos para el caso del espacio de articulación. 

Movimiento cartesiano en línea recta 

A menudo es conveniente poder especificar con facilidad una ruta espacial que haga que 
la punta de la herramienta se mueva a través del espacio en línea recta. Obviamente, si es¬ 
pecificamos muchos puntos vía con muy poca separación, distribuidos sobre una línea 
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recta, parecerá que la punta de la herramienta sigue una línea recta, sin importar la elec¬ 
ción de función uniforme que interconecte los puntos vía. No obstante, es mucho más con¬ 
veniente si la herramienta sigue rutas en línea recta entre puntos vía que tengan inclusive 
una amplia separación entre ellos. Este modo de especificación de ruta y ejecución se lla¬ 
ma movimiento cartesiano en línea recta. La capacidad de definir movimientos en términos 
de líneas rectas es un subconjunto de la capacidad más general del movimiento cartesia¬ 
no, en el cual pueden usarse funciones arbitrarias de variables cartesianas como funciones 
del tiempo para especificar una ruta. En un sistema que permita el movimiento cartesia¬ 
no general podrían ejecutarse rutas con formas tales como elipses o sinusoides. 

Al planear y generar rutas cartesianas en línea recta, es apropiado usar un traza¬ 
dor de funciones lineales con las mezclas parabólicas. Durante la porción lineal de ca¬ 
da segmento, los tres componentes de posición cambian en formal lineal, y el efector 
final se moverá a lo largo de una ruta lineal en el espacio. No obstante, si queremos es¬ 
pecificar la orientación como una matriz de rotación en cada punto vía, no podemos 
interpolar linealmente sus elementos ya que esto no necesariamente produciría una 
matriz de rotación válida en todo momento. Una matriz de rotación debe estar com¬ 
puesta de columnas ortonormales, y esta condición no podría garantizarse si se cons¬ 
truyera mediante la interpolación lineal de elementos matriciales entre dos matrices 
válidas, por lo que utilizaremos otra representación de la orientación. 

Según lo indicado en el capítulo 2, puede usarse la llamada representación ángulo- 
eje para especificar una orientación con tres números. Si combinamos esta representación 
de la orientación con la representación de la posición cartesiana de 3 x 1, tendremos 
una representación de 6 x 1 de la posición y orientación cartesianas. Considere un pun¬ 
to vía especificado en forma relativa a la trama estación como S A T. Es decir, la trama {A} 
especifica un punto vía con la posición del efector final indicada por s P AORG , y la orien¬ 
tación del efector final indicada por S A R. Esta matriz de rotación puede convertirse a la 
representación de ángulo-eje ROT( s K A , & SA )', o simplemente S K A . Utilizaremos el sím¬ 
bolo x P ara representar este vector de 6 x 1 de posición y orientación cartesianas. En 
consecuencia tenemos que 


s 


Xa = 


S p 

r AORG 

S K a 


(7.43) 


en donde S K A está formada por la aplicación de un cambio de escala al vector unitario 
s k a en una proporción igual a la cantidad de rotación 0 SA . Si cada punto de la ruta se 
especifica en esta representación, entonces hay que describir funciones de trazador que 
varíen uniformemente estas seis cantidades de un punto de ruta a otro, como funciones 
del tiempo. Si se utilizan trazadores lineales con mezclas parabólicas, la forma de la ru¬ 
ta entre los puntos vía será lineal. Al pasar por los puntos vía, la velocidad lineal y la 
velocidad angular del efector final cambian uniformemente. 

Tenga en cuenta que, a diferencia de otros esquemas de movimiento cartesiano 
en línea recta que se han propuesto, este método no garantiza que las rotaciones ocu¬ 
rran sobre un solo “eje equivalente” al moverse de un punto a otro. Nuestro esquema 
es uno simple que proporciona cambios de orientación uniformes y permite el uso de 
los mismos cálculos que ya hemos desarrollado para planear trayectorias interpoladas 
de articulaciones. 

Existe una ligera complicación por el hecho de que la representación ángulo-eje 
de la orientación no es única; esto es, 

( s K a , 0 sa ) — ( s K a , 6 sa + n360°), 


(7.44) 
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FIGURA 7.11: Selección de la representación ángulo-eje para minimizar la rotación. 

en donde n es cualquier entero positivo o negativo. Al pasar de un punto vía {A} a un 
punto vía {Z?}, debe minimizarse la cantidad total de rotación. Si nuestra representación 
de la orientación de ¡Aj se da como S K A , debemos seleccionar la S K B específica, de tal 
forma que | S K B — S K A se minimice. Por ejemplo, la figura 7.11 muestra cuatro posi¬ 
bles valores de S K B y su relación con la S K A dada. Los vectores de diferencia (líneas 
punteadas) se comparan para saber cuál S K B producirá la mínima rotación; en este ca¬ 
so, s K B( _ iy 

Una vez que seleccionemos los seis valores de / para cada punto vía, podremos 
usar los mismos cálculos que ya hemos desarrollado para generar trazadores que estén 
compuestas de secciones lineales y parabólicas. No obstante, debemos agregar una res¬ 
tricción más: los tiempos de mezcla para cada grado de libertad deben ser iguales. Esto 
asegurará que el movimiento resultante de todos los grados de libertad sea una línea 
recta en el espacio. Como todos los tiempos de mezcla deben ser iguales, la aceleración 
utilizada durante la mezcla para cada grado de libertad será distinta. Por lo tanto espe¬ 
cificamos una duración de mezcla y, con la ecuación (7.24), calculamos la aceleración 
necesaria (en lugar de hacerlo al revés). El tiempo de mezcla debe elegirse de manera 
que no se exceda de un cierto límite superior en la aceleración. 

Pueden usarse muchos otros esquemas para representar e interpolar la porción de 
orientación de una ruta cartesiana; por ejemplo, podrían usarse algunas de las otras re¬ 
presentaciones de 3 x 1 de la orientación que se presentaron en la sección 2.8. Por 
ejemplo, algunos robots industriales se mueven a lo largo de rutas cartesianas en línea 
recta en las que la interpolación de la orientación se realiza mediante una representa¬ 
ción similar a los ángulos de Euler Z-Y-Z. 

7.5 PROBLEMAS GEOMÉTRICOS CON LAS RUTAS CARTESIANAS 

Dado que se crea una correspondencia continua entre una forma de ruta descrita en es¬ 
pacio cartesiano y las posiciones de articulación, las rutas cartesianas son propensas a 
varios problemas relacionados con el espacio de trabajo y las singularidades. 
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Problemas de tipo 1: puntos intermedios inalcanzables 

Aunque la ubicación inicial de un manipulador y el punto de destino final se encuen¬ 
tren dentro del espacio de trabajo del manipulador, es muy posible que no todos los 
puntos distribuidos en una línea recta que conecten estos dos puntos se encuentren en 
el espacio de trabajo. Como ejemplo, considere el robot planar de dos vínculos que se 
muestra en la figura 7.12 y su espacio de trabajo asociado. En este caso el vínculo 2 es 
más corto que el vínculo 1, por lo que el espacio de trabajo contiene un agujero en la 
parte central, cuyo radio es la diferencia entre las longitudes de los vínculos. En el espacio 
de trabajo están dibujados un punto inicial A y un punto de destino B. Moverse de A a 
B en espacio de articulación no sería problema pero, si se intentara un movimiento en 
línea recta cartesiana, los puntos intermedios a lo largo de la ruta serían inalcanzables. 
Este es un ejemplo de una situación en la que una ruta en espacio de articulación pue¬ 
de ejecutarse fácilmente, pero una ruta en línea recta cartesiana fallaría. 2 

Problemas de tipo 2: velocidades de articulación altas cerca de una singularidad 

En el capítulo 5 vimos que existen ubicaciones en el espacio de trabajo del manipula¬ 
dor en donde es imposible elegir velocidades de articulación finitas que produzcan la 
velocidad deseada del efector final en espacio cartesiano. Por lo tanto, no debe sor¬ 
prender que haya ciertas rutas (descritas en términos cartesianos) que el manipulador 
no pueda recorrer. Por ejemplo, si un manipulador está siguiendo una ruta en línea rec¬ 
ta cartesiana y se acerca a una configuración singular del mecanismo, una o más velo¬ 
cidades de articulación podrían incrementarse hasta el infinito. Como las velocidades 


2 Algunos sistemas de robots notificarían al usuario sobre un problema antes de mover el manipulador; 
en otros, el movimiento empezaría a lo largo de la ruta hasta que alguna articulación llegara a su límite; en 
ese instante se detendría el movimiento del manipulador. 
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FIGURA 7.13: Problema de ruta cartesiana de tipo 2. 

del mecanismo tienen límites superiores, esta situación generalmente provoca que el 
manipulador se desvíe de la ruta deseada. 

Como un ejemplo, la figura 7.13 muestra un robot planar de dos vínculos (con 
longitudes de vínculo iguales) que se mueve a lo largo de una ruta, del punto A al pun¬ 
to B. La trayectoria deseada es mover la punta del extremo del manipulador, con una 
velocidad lineal constante, a lo largo de la ruta en línea recta. En la figura se han dibu¬ 
jado varias posiciones intermedias del manipulador para ayudarnos a visualizar su mo¬ 
vimiento. Todos los puntos a lo largo de la ruta son alcanzables, pero a medida que el 
robot avanza más allá de la porción media de la ruta, la velocidad de la articulación uno 
es más alta. Entre más se acerque la ruta al eje de la articulación uno, más rápido será 
este movimiento. Una solución es reducir la velocidad total de la ruta hasta que todas 
las articulaciones permanezcan dentro de sus capacidades de velocidad. De esta manera 
podrían perderse los atributos temporales deseados de la ruta, pero al menos se adhe¬ 
riría al aspecto espacial de la definición de la trayectoria. 

Problemas de tipo 3: inicio y destino alcanzables en distintas soluciones 

En la figura 7.14 se muestra un tercer tipo de problema que podría surgir. Aquí, un ro¬ 
bot planar de dos vínculos con iguales longitudes de vínculos tiene límites de articula¬ 
ción que restringen el número de soluciones con las que puede llegar a un punto dado 
en el espacio. Específicamente, surgiría un problema si el punto de destino no puede 
alcanzarse en la misma solución física en la que se encuentra el robot en el punto de 
inicio. En la figura 7.14, el manipulador puede llegar a todos los puntos de la ruta en 
cierta solución, pero no en una sola solución. En esta situación el sistema de planeación 
de trayectorias del manipulador puede detectar este problema sin necesidad de tratar de 
mover el robot a lo largo de la ruta, y puede indicar un error al usuario. 

Para manejar estos problemas con las rutas especificadas en espacio cartesiano, la 
mayoría de los sistemas de control de manipulador industriales soportan la generación 
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FIGURA 7.14: Problema de ruta cartesiana de tipo 3. 

de rutas en espacio de articulación y también en espacio cartesiano. El usuario aprende 
rápidamente que, debido a las dificultades con las rutas cartesianas, debe usar rutas pre¬ 
determinadas en espacio de articulación, y las rutas en espacio cartesiano deben usarse 
sólo cuando sea realmente necesario para la aplicación. 

7.6 GENERACIÓN DE RUTAS EN TIEMPO DE EJECUCIÓN 

En tiempo de ejecución, la rutina generadora de rutas construye la trayectoria, gene¬ 
ralmente en términos de 0, 0 y 0 , y alimenta esta información al sistema de control del 
manipulador. Este generador de rutas calcula la trayectoria a la frecuencia de actuali¬ 
zación de rutas. 

Generación de rutas en espacio de articulación 

El resultado de haber planeado una ruta mediante el uso de cualquiera de los métodos 
de interpolación por trazadores mencionados en la sección 7.3, es un conjunto de datos 
para cada segmento de la trayectoria. El generador de rutas utiliza estos datos en tiem¬ 
po de ejecución para calcular 0,0 y 6. 

En el caso de trazadores cúbicos, el generador de rutas simplemente calcula la ecua¬ 
ción (7.3) conforme se incrementa t. Cuando se llega al final de un segmento se solicita 
un nuevo conjunto de coeficientes cúbicos, t regresa a cero y la generación continúa. 

En el caso de trazadores lineales con mezclas parabólicas, se comprueba el valor 
del tiempo t en cada actualización para determinar si nos encontramos actualmente en 
la porción lineal o en la porción de mezcla del segmento. En la porción lineal, la tra¬ 
yectoria para cada unión se calcula así: 

o = 0j + é jk t, 
ó = é jk , 
o = o, 


(7.45) 
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en donde t es el tiempo transcurrido desde el y-ésimo punto vía y 6- k se calculó en el 
tiempo de planeación de la ruta mediante la ecuación (7.24). En la región de mezcla, la 
trayectoria para cada articulación se calcula así: 

Hnb = 1 - + *jk)’ 

e = e j +éj k (t-ti nb ) + 1 1 é k tl b , (7.46) 

^ ® jk + 'Ókhnb' 

e = 9 k , 

en donde Q- k , 0 k y t- k se calcularon en el tiempo de planeación de la ruta mediante las 
ecuaciones (7.24) a (7.28). Esto continúa, y t se restablece a \t k cuando se introduce un 
nuevo segmento lineal, hasta que hayamos pasado a través de todos los conjuntos de 
datos que representan los segmentos de la ruta. 


Generación de rutas de espacio cartesiano 

Para el esquema de ruta cartesiana presentado en la sección 7.4, utilizamos el generador 
de rutas para la ruta del trazador lineal con mezclas parabólicas. No obstante, los valo¬ 
res calculados representan la posición y orientación cartesianas en vez de los valores de 
variable de articulación, por lo que reescribimos las ecuaciones (7.45) y (7.46) con el sím¬ 
bolo x que representa un componente del vector de posición y orientación cartesiana. En 
la porción lineal del segmento, cada grado de libertad en x se calcula así: 


X=Xj+ x jk t, 

X=*j k ’ 
x — 0, 


(7.47) 


en donde t es el tiempo transcurrido desde el y-ésimo punto vía y x- k se calculó en el 
tiempo de planeación de la ruta mediante una ecuación análoga a la (7.24). En la re¬ 
gión de mezcla, la trayectoria para cada grado de libertad se calcula así: 

hnb = 1 ~ (bj + *jk)’ 

x = xj + x jk (t - t inb ) + jx k tf ny (7.48) 

i = x jk + x k t inb , 
x = x k , 

en donde las cantidades x- k , x k , t- y t- k se calcularon en el tiempo de planeación, de la 
misma forma que en el caso del espacio de articulación. 

Por último, esta trayectoria cartesiana (/, x y /) debe convertirse en cantidades 
equivalentes en espacio de articulación. Una solución analítica completa para este pro¬ 
blema utilizaría la cinemática inversa para calcular las posiciones de las articulaciones, el 
jacobiano inverso para las velocidades y el jacobiano inverso más su derivada para las 
aceleraciones [5]. Una forma más sencilla que se utiliza mucho en la práctica es la siguien¬ 
te: en la proporción de actualización de ruta convertimos / en su representación de tra¬ 
ma equivalente, f¡ T. Después utilizamos la rutina RESOLVER (vea la sección 4.8) 
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para calcular el vector requerido de los ángulos de articulación 0. Luego utilizamos di¬ 
ferenciación numérica para calcular © y 0. 3 Por consecuencia, el algoritmo es 



0(0 = RESOLVER( s g T). 


0(f) — 0(r — St ) 
St 

0(í) — 0(í — St) 
St 


0(0 


(7.49) 


©(0 


Entonces se proporcionan 0, © y 0 al sistema de control del manipulador. 

7.7 DESCRIPCIÓN DE RUTAS CON UN LENGUAJE DE PROGRAMACIÓN DE ROBOTS 

En el capítulo 12 hablaremos más sobre los lenguajes de programación de robots. Aquí 
ilustraremos cómo podrían especificarse en un lenguaje de robot varios tipos de rutas 
que hemos visto en este capítulo. En estos ejemplo utilizaremos la sintaxis de AL, un 
lenguaje de programación de robots desarrollado en la Universidad de Stanford [6]. 

Los símbolos A, B, C y D representan variables de tipo “trama” en los ejemplos 
de lenguaje AL que se muestran a continuación. Estas tramas especifican puntos de ru¬ 
ta que supondremos se han enseñado o se han descrito textualmente para el sistema. 
Suponga que el manipulador empieza en la posición A. Para mover el manipulador 
(ARM) en modo de espacio de articulación a lo largo de rutas de mezcla parabólica-li- 
neal, podríamos decir 

move ARM to C with duration = 3*seconds; 

Para movernos a la misma posición y orientación en una línea recta podríamos decir 
move ARM to C linearly with duration = 3*seconds; 
en donde la palabra clave “linearly” denota que se va a usar el movimiento cartesiano en 
línea recta. Si la duración (duration) no es importante, se puede omitir esta especifica¬ 
ción y el sistema utilizará una velocidad predeterminada; esto es, 
move ARM to C; 

Si queremos agregar un punto vía, escribimos 
move ARM to C via B; 

o podría especificarse todo un conjunto de puntos vía mediante 
move ARM to C via B,A,D; 

Observe que en 

move ARM to C via B with duration = 6*seconds; 
se proporciona la duración para todo el movimiento. El sistema decide cómo dividir es¬ 
ta duración entre los dos segmentos. En AL es posible especificar la duración de un so¬ 
lo segmento; por ejemplo, mediante 

move ARM to C via B where duration = 3*seconds; 

El primer segmento que conduzca al punto B tendrá una duración de 3 segundos. 

7.8 PLANEACIÓN DE RUTAS CUANDO SE USA EL MODELO DINÁMICO 

Generalmente, cuando se planean rutas utilizamos una aceleración predeterminada o má¬ 
xima en cada punto de mezcla. En realidad, la cantidad de aceleración que el manipulador 

3 Esta diferenciación puede realizarse de manera no causal para las rutas previamente planeadas, pro¬ 
duciendo 0 y 0 de mejor calidad. Además, muchos sistemas de control no requieren una entrada 0, por 
lo que no se calcularía 





Bibliografía 225 


es capaz de producir en cualquier instante es una función de la dinámica del brazo y de los 
límites del actuador. La mayoría de los actuadores no se caracterizan por un momento de 
torsión o una aceleración máxima fija, sino por una curva momento de torsión-velocidad. 

Cuando planeamos una ruta suponiendo que hay una aceleración máxima en ca¬ 
da articulación o a lo largo de cada grado de libertad, estamos haciendo una gran sim¬ 
plificación. Para tener cuidado de no exceder las capacidades reales del dispositivo, esta 
aceleración máxima debe elegirse de manera conservadora. Por lo tanto, no estamos 
utilizando por completo las capacidades de velocidad del manipulador en rutas planea¬ 
das por los métodos que presentamos en este capítulo. 

Podríamos hacer la siguiente pregunta: dada una ruta espacial deseada del efec- 
tor final, encuentre la información de temporización (que convierte la descripción de 
una ruta espacial en una trayectoria) de tal forma que el manipulador llegue al punto 
de destino en un tiempo mínimo. Dichos problemas se han resuelto mediante métodos 
numéricos [7, 8], La solución toma en cuenta la dinámica del cuerpo rígido y las curvas 
de restricción de velocidad-momento de torsión del actuador. 

7.9 PLANEACIÓN DE RUTAS SIN COLISIONES 

Sería muy conveniente simplemente decir al sistema de robot cuál es el punto de des¬ 
tino deseado del movimiento del manipulador y dejar que el sistema determine en dón¬ 
de y cuántos puntos vía se requieren para llegar al destino sin que el manipulador 
choque contra algún obstáculo. Para ello, el sistema debe tener modelos del manipula¬ 
dor, del área de trabajo y de todos los posibles obstáculos en el área. Incluso podría ha¬ 
ber otro manipulador trabajando en la misma área, en cuyo caso cada brazo tendría 
que considerarse como un obstáculo móvil para el otro. 

Los sistemas que planean rutas sin colisiones no están disponibles comercialmente. 
La investigación en esta área ha permitido descubrir dos técnicas rivales principales, jun¬ 
to con diversas variaciones y combinaciones de las mismas. Uno de los métodos resuelve 
el problema formando una representación en gráficos conectados del espacio libre y des¬ 
pués buscando en el gráfico una ruta sin colisiones [9-11,17,18]. Desafortunadamente es¬ 
tas técnicas tienen una complejidad exponencial en el número de articulaciones en el 
dispositivo. El segundo método se basa en la creación de campos artificales de potencial 
alrededor de los obstáculos que hacen que el o los manipuladores eviten los obstáculos 
mientras son atraídos hacia un polo de atracción artificial en el punto de destino [12]. Por 
desgracia estos métodos casi siempre tienen una vista local del entorno y pueden quedar 
“atascados” en los mínimos locales del campo artificial. 
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EJERCICIOS 

7.1 [8] ¿Cuántos polinomios cúbicos individuales se calculan cuando un robot de seis ar¬ 
ticulaciones se mueve a lo largo de una ruta de trazador cúbico a través de dos pun¬ 
tos vía y se detiene en un punto de destino? ¿Cuántos coeficientes se almacenan para 
describir estos polinomios cúbicos? 

7.2 [13] Un robot de un solo vínculo con una articulación giratoria está sin movimiento, 
con 6 = —5 o . Se desea mover la articulación de una manera uniforme hasta 9 = 80° en 
4 segundos y que se detenga uniformemente. Encuentre los coeficientes de un polino¬ 
mio cúbico que logre este movimiento y lleve el brazo al punto de destino, en donde 
quedará inmóvil. Trace la posición, la velocidad y la aceleración de la articulación co¬ 
mo una función del tiempo. 

7.3 [14] Un robot de un solo vínculo con una articulación giratoria está sin movimiento, 
con 9 = —5 o . Se desea mover la articulación de una manera uniforme hasta 9 = 80° en 
4 segundos y que se detenga uniformemente. Calcule los parámetros correspondien¬ 
tes de una trayectoria lineal con mezclas parabólicas. Trace la posición, la velocidad y 
la aceleración de la articulación como una función del tiempo. 

7.4 [30] Escriba una rutina de software para una planeación de ruta que implemente las 
ecuaciones (7.24) a (7.28) de una forma general para las rutas descritas por un número 
arbitrario de puntos de ruta. Esta rutina podría utilizarse para resolver el ejemplo 7.4. 

7.5 [18] Bosqueje gráficos de posición, velocidad y aceleración para el trazador de aceleración 
continua de dos segmentos dado en el ejemplo 7.2. Haga los bosquejos para una articula¬ 
ción en la que 9 0 = 5.0°, 9 V = 15.0°, 9 g = 40.0° y que cada segmento dure 1.0 segundos. 
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7.6 [18] Bosqueje gráficos de posición, velocidad y aceleración para un trazador de dos 
segmentos, en donde cada segmento sea un polinomio cúbico, utilizando los coeficien¬ 
tes que se proporcionan en la ecuación (7.11). Haga los bosquejos para una articula¬ 
ción en la que 9 0 = 5.0° para el punto inicial, 9 V = 15.0° sea un punto vía y 9 g = 40.0° 
sea el punto de destino. Suponga que cada segmento tiene una duración de 1.0 segun¬ 
do y que la velocidad en el punto vía es de 17.5 grados/segundo. 

7.7 [20] Calcule 0 12 , 9 23 , t v t 2 y t 3 para una trazador lineal de dos segmentos con mezclas 
parabólicas. [Use las ecuaciones (7.24) a (7.28)]. Para esta articulación, 9 1 = 5.0°, 9 2 = 
15.0°, 9 3 = 40.0°. Suponga que t dl2 = t d23 = 1.0 segundos y que la aceleración prede¬ 
terminada a utilizar durante las mezclas es de 80 grados/seg 2 . Bosqueje trazos de po¬ 
sición, velocidad y aceleración en 9. 

7.8 [18] Bosqueje gráficos de posición, velocidad y aceleración para el trazador de dos 
segmentos y aceleración continua que se proporciona en el ejemplo 7.2. Haga los bos¬ 
quejos para una articulación en la que 0 O = 5.0°, 9 v = 15.0°, 9 g = —10.0° y que cada 
segmento dure 2.0 segundos. 

7.9 [18] Bosqueje gráficos de posición, velocidad y aceleración para un trazador de dos 
segmentos en el que cada segmento sea un polinomio cúbico, utilizando los coeficien¬ 
tes que se proporcionan en la ecuación (7.11). Haga los bosquejos para una articula¬ 
ción en la que 9 0 = 5.0° para el punto inicial, 9 V = 15.0° sea un punto vía y 9 g = —10.0° 
sea el punto de destino. Suponga que cada segmento tiene una duración de 2.0 segun¬ 
dos y que la velocidad en el punto vía es de 0.0 grados/segundo. 

7.10 [20] Calcule 0 n , 9 23 , t v t 2 y t 3 para un trazador lineal de dos segmentos con mezclas pa¬ 
rabólicas. [Use las ecuaciones (7.24) a (7.28)]. Para esta articulación, 9 1 = 5.0°, 9 2 = 
15.0°, 9 3 = —10.0°. Suponga que t dn = t d23 = 2.0 segundos y que la aceleración prede¬ 
terminada a utilizar durante las mezclas es de 60 grados/seg 2 . Bosqueje trazos de po¬ 
sición, velocidad y aceleración en 9. 

7.11 [6] Proporcione la representación s y (; de la posición y la orientación cartesianas de 6 x 1 
que sea equivalente a ¿7) en donde ¿t R = ROT(Z, 30°) y s P GORG = [10.0 20.0 30.0] r . 

7.12 [6] Proporcione la ^ T que sea equivalente a la representación de la posición y la orien¬ 
tación cartesianas de 6 x 1, representada por s x G =[5.0 —20.0 10.0 45.0 0.0 0.0] r . 

7.13 [30] Escriba un programa que utilice las ecuaciones dinámicas de la sección 6.7 (el ma¬ 
nipulador planar de dos vínculos) para calcular el historial en tiempo de los momen¬ 
tos de torsión necesarios para mover el brazo a lo largo de la trayectoria del ejercicio 
7.8. ¿Cuáles son los máximos momentos de torsión requeridos y en dónde ocurren a 
lo largo de la trayectoria? 

7.14 [32] Escriba un programa que utilice las ecuaciones dinámicas de la sección 6.7 (el ma¬ 
nipulador planar de dos vínculos) para calcular el historial en tiempo de los momen¬ 
tos de torsión necesarios para mover el brazo a lo largo de la trayectoria del ejercicio 
7.8. Realice trazos separados de los momentos de torsión requeridos debido a la iner¬ 
cia, los términos de la velocidad y la gravedad. 

7.15 [22] Haga el ejemplo 7.2 cuando + t^. 

7.16 [25] Deseamos mover una sola articulación de 9 0 a 6^ que empiece desde una posición 
inmóvil y termine en una posición inmóvil, en el tiempo Se proporcionan los valo¬ 
res de 9 0 y 9^ , pero deseamos calcular tj de tal forma que | |0(í)| | < 9 máx y | \9 (f)| | < 9 máx 
para todos los valores de t en donde a 9 máx y 9 máx se les asignen constantes positivas. 
Utilice un solo segmento cúbico y proporcione una expresión para t, y para los coefi¬ 
cientes del polinomio cúbico. 

7.17 [10] Una trayectoria cúbica individual se da mediante 

9{t) = 10 + 90 1 ¿ - óOr 3 

y se utiliza sobre el intervalo de tiempo desde t = 0 hasta t = 1. ¿Cuáles son las posi¬ 
ciones, las velocidades y las aceleraciones iniciales y finales? 
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7.18 [12] Una trayectoria cúbica individual se da mediante 

9(t ) = 10 + 90f 2 - 60t 3 

y se utiliza sobre el intervalo de t = 0 hasta t = 2. ¿Cuáles son las posiciones, las velo¬ 
cidades y las aceleraciones iniciales y finales? 

7.19 [13] Una trayectoria cúbica individual se da mediante 

8(t) = 10 + 5r + 70? 2 - 45í 3 

y se utiliza sobre el intervalo de t = 0 hasta t = 1. ¿Cuáles son las posiciones, las velo¬ 
cidades y las aceleraciones iniciales y finales? 

7.20 [12] Una trayectoria cúbica individual se da mediante 

8(t) = 10 + 5r + 70r 2 - 45í 3 

y se utiliza sobre el intervalo de t = 0 hasta t = 2. ¿Cuáles son las posiciones, las velo¬ 
cidades y las aceleraciones iniciales y finales? 

EJERCICIO DE PROGRAMACIÓN (PARTE 7) 

1. Escriba un sistema de planeación de rutas tipo trazador cúbico en espacio de articu¬ 
lación. Una rutina que su sistema deberá incluir es 

Procedure COEFCUB (VAR th0, thf, thpunto0, thpuntof: real; 

VAR cc: vec4); 

en donde 

thü = posición inicial de 9 en la parte inicial del segmento, 
thf = posición final de 9 en la parte final del segmento, 
thpuntoO = velocidad inicial del segmento, 
thpuntof = velocidad final del segmento. 

Estas cuatro cantidades son entradas y “cc”, es un arreglo de los cuatro coeficientes 
cúbicos, es la salida. 

Su programa deberá aceptar (cuando menos) cinco especificaciones de puntos vía, en 
la forma de trama herramienta ¡L] respecto a la trama estación [5], en el formato co¬ 
mún de usuario: (jc, y, 0). Para facilitarnos la vida, todos los segmentos tendrán la mis¬ 
ma duración. Su sistema deberá despejar los coeficientes de los polinomios cúbicos 
usando cierta heurística razonable para asignar velocidades de articulación en los 
puntos vía. Sugerencia : vea la opción 2 en la sección 7.3. 

2 . Escriba un sistema generador de rutas que calcule una trayectoria en el espacio de ar¬ 
ticulación basada en conjuntos de coeficientes cúbicos para cada segmento. Debe ser 
capaz de generar la ruta de varios segmentos que usted planeó en el problema 1. El 
usuario deberá especificar una duración para los segmentos. Deberá producir infor¬ 
mación sobre la posición, la velocidad y la aceleración a la frecuencia de actualización 
de ruta, que también deberá especificar el usuario. 

3. El manipulador es el mismo de tres vínculos que se usó anteriormente. Las definicio¬ 
nes de las tramas ¡T} y [5] son las mismas que antes: 

= [x y 9] = [0.1 0.2 30.0], 
b s T = [x y 9] = [0.0 0.0 0.0], 
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Utilizando una duración de 3.0 segundos por segmento, planee y ejecute la ruta que 
empieza con el manipulador en la posición 

[x 4 y 1 0, | = [0.758 0.173 0.0], 

que se desplaza a través de los puntos vía 

[x 2 y 2 0t] = [0-6 —0.3 45.0] 


y 


[JC 3 y 3 <p 3 ] = [-0.4 0.3 120.0], 

y que termina en el punto de destino (en este caso, el mismo que el punto inicial) 

[jc 4 y 4 <j> 4 \ = [0.758 0.173 0.0], 


Use una frecuencia de actualización de ruta de 40 Hz, pero imprima la posición sólo ca¬ 
da 0.2 segundos. Imprima las posiciones en términos cartesianos para usuario. No tiene 
que imprimir velocidades o aceleraciones, aunque sería conveniente hacerlo. 
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El objetivo de este ejercicio es implementar ecuaciones polinomiales de generación de tra¬ 
yectorias en espacio de articulación para una sola articulación. (Para varias articulaciones 
se requerirían n aplicaciones del resultado). Escriba un programa en MATLAB para imple¬ 
mentar la generación de trayectorias en espacio de articulación para los tres casos siguientes. 
Reporte sus resultados para las asignaciones específicas dadas; en cada caso, proporcione 
las funciones polinomiales para el ángulo de articulación, la velocidad angular, la acelera¬ 
ción angular y la derivada en el tiempo de la aceleración angular. Para cada caso trace los 
resultados. (Ordene los trazos verticalmente con ángulo, velocidad, aceleración y después 
la derivada de la aceleración, todo con la misma escala de tiempo; compruebe la función 
subplot de MATLAB para lograr esto.) No sólo trace los resultados, comente algo; ¿sus re¬ 
sultados tienen sentido? He aquí los tres casos: 


a) Polinomio de tercer orden. Haga que la velocidad angular sea cero al principio y al fi¬ 
nal. Se dan 0 S = 120° (inicio), 6j = 60° (final) y zy = 1 segundo. 

b) Polinomio de quinto orden. Haga que la velocidad angular y la aceleración sean cero 
al principio y al final. Se dan 6 s = 120°, 0j = 60° y y = 1 segundo. Compare sus resul¬ 
tados (funciones y trazos) con este mismo ejemplo, pero usando un polinomio de ter¬ 
cer orden, como en el problema (a). 

c) Dos polinomios de tercer orden con punto vía. Haga que la velocidad angular sea ce¬ 
ro al principio y al final. No haga que la velocidad angular sea cero en el punto vía; se 
deben igualar la velocidad y la aceleración en este punto para que los dos polinomios 
se encuentren en ese punto en el tiempo. Demuestre que se satisface esta condición. Se 
dan 6 S = 60° (inicio), 9 V = 120° (vía), 6, = 30° (final) y t t = t 2 =1 segundo (intervalos 
relativos; por ejemplo, y = 2 segundos). 

d) Compruebe los resultados de (a) y (b) mediante la Caja de Herramientas de Robóti- 
ca MATLAB de Corke. Pruebe la función jtrajQ. 
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8.1 INTRODUCCIÓN 

En capítulos anteriores hemos visto que la estructura específica de un manipulador 
ejerce influencia sobre el análisis cinemático y dinámico. Por ejemplo, ciertas configu¬ 
raciones cinemáticas serán fáciles de resolver; otras no tendrán solución cinemática de 
forma cerrada. De igual forma, la complejidad de las ecuaciones dinámicas puede va¬ 
riar considerablemente con la configuración cinemática y la distribución de la masa de 
los vínculos. En los siguientes capítulos veremos que el control del manipulador no só¬ 
lo depende de la dinámica de cuerpo rígido, sino también de la fricción y la flexibilidad 
de los sistemas controladores. 

Las tareas que pueda realizar un manipulador también variarán considerablemen¬ 
te con el diseño específico. Aunque generalmente hemos tratado con el manipulador del 
robot como una entidad abstracta, su rendimiento está limitado en última instancia por 
factores pragmáticos tales como la capacidad de carga, la velocidad, el tamaño del espa¬ 
cio de trabajo y la repetitividad. Para ciertas aplicaciones, el tamaño total del manipula¬ 
dor, su peso, su consumo de energía y su costo serán factores de consideración. 

En este capítulo hablaremos de algunas de las cuestiones involucradas en el dise¬ 
ño del manipulador. En general, los métodos de diseño e incluso la evaluación de un 
diseño terminado son temas parcialmente subjetivos. Es difícil limitar el espectro de 
opciones de diseño con muchas reglas inflexibles. 

Los elementos de un sistema de robot pueden dividirse en cuatro categorías: 

1. El manipulador, incluyendo sus sensores internos o propioceptivos. 

2. El efector final, o herramientas en el extremo del brazo. 

3. Sensores y efectores externos, como sistemas de visión y alimentadores de piezas. 

4. El controlador. 
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La amplitud de disciplinas de ingeniería que se abarcan nos obliga a restringir 
nuestra atención únicamente al diseño del manipulador en sí. 

Para desarrollar el diseño de un manipulador, empezamos examinando los factores 
que probablemente tengan el mayor efecto general en el diseño y después considera¬ 
mos las preguntas más detalladas. No obstante, en el fondo el diseño de un manipula¬ 
dor es un proceso iterativo. Es muy probable que los problemas que surgen al resolver 
un detalle de diseño nos obliguen a reformular las decisiones anteriores de diseño de un 
mayor nivel. 

8.2 DISEÑO BASADO EN LOS REQUERIMIENTOS DE LA TAREA 

Aunque los robots son nominalmente máquinas “umversalmente programables”, capaces 
de realizar una amplia variedad de tareas, factores prácticos y económicos dictan que se 
deben diseñar distintos manipuladores para tipos específicos de tareas. Por ejemplo, los 
grandes robots capaces de manejar cargas útiles de cientos de libras no tienen general¬ 
mente la capacidad de insertar componentes electrónicos en tableros de circuitos. Co¬ 
mo veremos, no sólo el tamaño, sino también el número de articulaciones, el orden de 
las articulaciones y los tipos de accionamiento, detección y control variarán enorme¬ 
mente con el tipo de tarea a realizar. 

Número de grados de libertad 

El número de grados de libertad en un manipulador debe concordar con el número re¬ 
querido por la tarea. No todas las tareas requieren de seis grados completos de libertad. 

La circunstancia más común de este tipo ocurre cuando el efector final tiene un 
eje de simetría. La figura 8.1 muestra a un manipulador colocando una herramienta de 
esmerilado en dos formas distintas. En este caso, la orientación de la herramienta res¬ 
pecto al eje de la misma, Z v es irrelevante, ya que la muela está girando a varios cien¬ 
tos de RPM. Al decir que podemos posicionar este robot 6-DOF (seis grados de 
libertad) en una infinidad de formas para esta tarea (la rotación sobre Z T es una varia¬ 
ble libre), estamos diciendo que el robot es redundante para esta tarea. La soldadura 
con arco, la soldadura por puntos, el desbarbado, el encolado y el pulido son otros 
ejemplos de tareas que a menudo emplean efectores finales con cuando menos un eje 
de simetría. 



FIGURA 8.1: Un manipulador 6-DOF con una herramienta simétrica contiene un grado 
redundante de libertad. 
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Al analizar la situación de la herramienta simétrica, algunas veces es útil imagi¬ 
nar una articulación ficticia cuyo eje esté sobre el eje de simetría. Al colocar un efector 
final en una ubicación específica, necesitamos un total de seis grados de libertad. Co¬ 
mo una de estas seis es nuestra herramienta ficticia, el manipulador no necesita tener 
más de cinco grados de libertad. Si se utilizara un robot 5-DOF en la aplicación de la 
figura 8.1, entonces regresaríamos al caso común en el que sólo hay un número finito 
de soluciones distintas disponibles para posicionar la herramienta. Un gran porcentaje de 
los robots industriales existentes son 5-DOF, reconociendo el relativo predominio de las 
aplicaciones con herramientas simétricas. 

Algunas tareas se llevan a cabo en dominios que, fundamentalmente, tienen me¬ 
nos de seis grados de libertad. La colocación de componentes en tableros de circuitos 
es un ejemplo común de esto. Por lo general, los tableros de circuitos son planares y 
contienen piezas de varias alturas. Para posicionar piezas en una superficie planar se re¬ 
quieren tres grados de libertad (x, y y 0); para poder levantar e insertar las piezas se 
agrega un cuarto movimiento normal al plano (z). 

Los robots con menos de seis grados de libertad pueden también realizar tareas 
en las que cierto tipo de dispositivo de colocamiento activo presenta las piezas. Por 
ejemplo, en la soldadura de tuberías, una plataforma de inclinación/giro, como la mos¬ 
trada en la figura 8.2, es la que comúnmente presenta las piezas a soldar. Al contar el 
número de grados de libertad entre los tubos y el efector final, la plataforma de incli- 
nación/giro representa dos. Esto, junto con el hecho de que la soldadura de arco es una 
tarea de herramienta simétrica, significa que en teoría podría usarse un manipulador 
3-DOF. En la práctica, la necesidad de evitar colisiones con la pieza de trabajo es lo que 
al final hace que se utilice un robot con más grados de libertad. 

Las piezas con un eje de simetría también reducen los grados requeridos de liber¬ 
tad para el manipulador. Por ejemplo, las piezas cilindricas pueden en muchos casos re¬ 
cogerse e insertarse independientemente de la orientación del sujetador, respecto al eje 
del cilindro. No obstante, hay que tener en cuenta que, una vez sujeta la pieza, la orien¬ 
tación de ésta sobre su eje simétrico no debe importar en todas las operaciones subsi¬ 
guientes, ya que no está garantizada su orientación. 



FIGURA 8.2: Una plataforma de inclinación/giro proporciona dos grados de libertad al 
sistema manipulador general. 
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Espacio de trabajo 

Para realizar tareas, un manipulador tiene que alcanzar determinado número de piezas 
de trabajo o dispositivos fijos. En algunos casos estos objetos pueden colocarse, según 
sea necesario, para adaptarse al espacio de trabajo del manipulador. En otros casos 
puede instalarse un robot en un entorno fijo con requerimientos de un espacio de tra¬ 
bajo rígido. Al espacio de trabajo también se le llama algunas veces volumen de traba¬ 
jo o envoltura de trabajo. 

La escala total de la tarea establece el espacio de trabajo requerido del manipu¬ 
lador. En algunos casos, los detalles de la forma del espacio de trabajo y la ubicación 
de las singularidades del mismo serán consideraciones importantes. 

La intrusión del manipulador en el espacio de trabajo puede algunas veces ser un 
factor. Dependiendo del diseño cinemático, la operación de un manipulador en una 
aplicación dada podría requerir más o menos espacio alrededor de los dispositivos fijos 
para poder evitar colisiones. Los entornos restringidos pueden afectar la elección de la 
configuración cinemática. 

Capacidad de carga 

La capacidad de carga de un manipulador depende del tamaño de sus miembros estruc¬ 
turales, del sistema de transmisión de energía y de los actuadores. La carga colocada en 
los actuadores y en el sistema de control es una función de la configuración del robot, 
del porcentaje de tiempo que se soporta una carga y de la carga dinámica debida a las 
fuerzas relacionadas con la inercia y la velocidad. 

Velocidad 

Un objetivo obvio en el diseño ha sido tratar de crear manipuladores cada vez más rá¬ 
pidos. La alta velocidad ofrece ventajas en muchas aplicaciones en las que una solución 
robótica propuesta debe competir en términos económicos con trabajadores humanos 
o sistemas automáticos. No obstante, para algunas aplicaciones el proceso en sí es el que 
limita la velocidad, y no el manipulador. Este es el caso con muchas aplicaciones de sol¬ 
dadura y pintura con pistola de aire. 

Hay una distinción importante entre la máxima velocidad del efector final y el 
tiempo de ciclo total para una tarea específica. Para las aplicaciones que involucran 
sujetar y colocar, el manipulador debe acelerar y desacelerar hacia y desde las ubica¬ 
ciones de sujetar y colocar dentro de ciertos rangos de precisión en la posición. A me¬ 
nudo, las fases de aceleración y desaceleración ocupan la mayor parte del tiempo de 
ciclo. Por consecuencia, la capacidad de aceleración es muy importante, no sólo la ve¬ 
locidad pico. 

Repetitividad y precisión 

Es muy costoso lograr una alta repetitividad y precisión, aunque es algo muy conve¬ 
niente en el diseño de cualquier manipulador. Por ejemplo, sería absurdo diseñar un 
robot de pintura con pistola de aire para ser preciso dentro de un margen de 0.001 pul¬ 
gadas cuando el diámetro del punto que se va a pintar es de 8 ± 2 pulgadas. En buena 
medida, la precisión de un modelo específico de robot industrial depende de los deta¬ 
lles de su fabricación, y no de su diseño. La alta precisión se logra mediante un buen 
conocimiento de los parámetros del vínculo (y otros más). Para hacer esto posible se 
necesitan mediciones precisas después de la fabricación, o una cuidadosa atención a las 
tolerancias durante la fabricación. 
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8.3 CONFIGURACIÓN CINEMÁTICA 

Una vez que se ha decidido el número requerido de grados de libertad, debe seleccionar¬ 
se una configuración específica de articulaciones para realizar esos grados de libertad. Pa¬ 
ra los vínculos cinemáticos seriales, el número de articulaciones es igual al número 
requerido de grados de libertad. La mayoría de los manipuladores están diseñados de 
manera que las últimas n — 3 articulaciones orienten al efector final y tengan ejes que 
se intersequen en el punto de la muñeca, y las primeras tres articulaciones colocan 
este punto de la muñeca. Se puede decir que los manipuladores con este diseño están 
compuestos de una estructura de posicionamiento, seguida de una estructura de orien¬ 
tación o muñeca. Como vimos en el capítulo 4, estos manipuladores siempre tienen so¬ 
luciones cinemáticas de forma cerrada. Aunque existen otras configuraciones que 
poseen soluciones cinemáticas de forma cerrada, casi todos los manipuladores indus¬ 
triales pertenecen a esta clase de mecanismos con partición de muñeca. Además, la 
estructura de posicionamiento está, casi sin excepciones, diseñada para ser cinemática¬ 
mente simple, con torsiones de vínculos iguales a 0 o ±90 grados, y con muchas de las 
longitudes de vínculos y desplazamientos iguales a cero. 

Se ha convertido en una costumbre clasificar los manipuladores de la clase simple 
cinemática, con partición de muñeca, de acuerdo con el diseño de sus primeras tres ar¬ 
ticulaciones (la estructura de posicionamiento). En los siguientes párrafos describire¬ 
mos brevemente la más común de estas clasificaciones. 

Cartesiano 

Un manipulador cartesiano es tal vez la configuración más simple. Como se muestra en 
la figura 8.3, las articulaciones, de la 1 a la 3, son prismáticas, mutuamente ortogonales 
y corresponden a las direcciones cartesianas X, Y y Z. La solución cinemática inversa 
para esta configuración es trivial. 

Esta configuración produce robots con estructuras muy rígidas. Como consecuen¬ 
cia pueden construirse robots bastante grandes. Estos grandes robots, conocidos común¬ 
mente como robots de puente transversal, se asemejan a las grúas corredizas aéreas. Los 
robots de puente transversal algunas veces manipulan automóviles completos o inspec¬ 
cionan aeronaves completas. 

Las otras ventajas de los manipuladores cartesianos se deben al hecho de que las 
primeras tres articulaciones están desacopladas. Esto facilita su diseño y evita las sin¬ 
gularidades cinemáticas debidas a las primeras tres articulaciones. 




FIGURA 8.3: Un manipulador articulado. 
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Su principal desventaja es que todos los alimentadores y dispositivos fijos asocia¬ 
dos con una aplicación deben encontrarse “dentro” del robot. En consecuencia, las celdas 
de trabajo de las aplicaciones para los robots cartesianos se vuelven muy dependientes de 
la máquina. El tamaño de la estructura de soporte del robot limita el tamaño y la colo¬ 
cación de los dispositivos fijos y los sensores. Estas limitaciones hacen extremadamen¬ 
te difícil el proceso de modernizar los robots cartesianos para adaptarlos a las celdas de 
trabajo existentes. 

Articulado 

La figura 8.4 muestra un manipulador articulado, algunas veces llamado también ma¬ 
nipulador de codo o antropomórfico. Un manipulador de este tipo generalmente con¬ 
siste en dos articulaciones tipo “hombro” (una para girar sobre un eje vertical y otra 
para elevarse en el plano horizontal), una articulación tipo “codo” (cuyo eje es normal¬ 
mente paralelo a la articulación de elevación del hombro) y dos o tres articulaciones de 
muñeca en el extremo del manipulador. Tanto el PUMA 560 como el Motoman L-3, 
que estudiamos en capítulos anteriores, se encuentran dentro de esta categoría. 

Los robots articulados minimizan la intrusión de la estructura del manipulador en 
el espacio de trabajo, haciéndolos capaces de llegar a espacios confinados. Requieren 
de una estructura total mucho menor que los robots cartesianos, lo que los hace menos 
costosos para aplicaciones que requieren de espacios de trabajo más pequeños. 

SCARA 

La configuración SCARA, 1 como la que se muestra en la figura 8.5, tiene tres articula¬ 
ciones angulares paralelas (que le permiten moverse y orientarse en un plano), con una 
cuarta articulación prismática para mover el efector final de forma normal al plano. La 
ventaja principal es que las primeras tres articulaciones no tienen que soportar el peso del 
manipulador o de la carga. Además, el vínculo 0 puede alojar fácilmente los actuadores 
para las primeras dos articulaciones. Los actuadores pueden hacerse bastante grandes, por 
lo que el robot puede moverse con gran rapidez. Por ejemplo, un manipulador SCARA 



FIGURA 8.4: Un manipulador articulado. 


1 SCARA significa “brazo de robot con montaje selectivamente obediente”, por sus siglas en inglés. 
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FIGURA 8.5: Un manipulador SCARA. 


puede moverse a una velocidad de hasta 30 pies por segundo, casi 10 veces más rápi¬ 
do que la mayoría de los robots industriales articulados [1]. Esta configuración se adap¬ 
ta mejor a las tareas en entornos planos. 

Esférico 

La configuración esférica de la figuras 8.6 tiene muchas similitudes con el manipulador 
articulado, sólo que la articulación tipo codo se remplaza por una articulación prismá¬ 
tica. Este diseño se adapta mejor que el diseño tipo codo en algunas aplicaciones. El 
vínculo que se mueve prismáticamente podría plegarse como telescopio (o incluso “sa¬ 
lirse por detrás”) al retractarse. 

Cilindrico 

Los manipuladores cilindricos (figura 8.7) consisten de una articulación prismática pa¬ 
ra trasladar el brazo en forma vertical, una articulación angular con un eje vertical, otra 
articulación prismática ortogonal al eje de la articulación angular y, finalmente, una 
muñeca de cierto tipo. 



FIGURA 8.6: Un manipulador esférico. 
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FIGURA 8.7: Un manipulador cilindrico. 


Muñecas 

Las configuraciones de muñeca más comunes consisten en dos o tres articulaciones an¬ 
gulares con ejes ortogonales que se intersecan. Por lo regular, la primera articulación 
de muñeca forma la articulación 4 del manipulador. 

Una configuración de tres ejes ortogonales garantiza que pueda lograrse cualquier 
orientación (suponiendo que no haya límites de los ángulos de las articulaciones) [2]. 
Como se mencionó en el capítulo 4, cualquier manipulador con tres ejes consecutivos 
que se intersecan poseerá una solución cinemática de forma cerrada. Por lo tanto, una 
muñeca con tres ejes ortogonales puede ubicarse en el extremo del manipulador en 
cualquier orientación deseada sin problemas. La figura 8.8 es un diagrama esquemáti¬ 
co de un posible diseño de dicha muñeca que utiliza varios conjuntos de engranajes có¬ 
nicos para controlar el mecanismo desde actuadores remotamente ubicados. 

En la práctica, es difícil construir una muñeca con tres ejes ortogonales que no esté 
sujeta a limitaciones bastante severas de los ángulos de las articulaciones. Un interesante 





FIGURA 8.8: Una muñeca con eje ortogonal controlada por actuadores remotamente 
ubicados, mediante tres ejes concéntricos. 
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diseño utilizado en varios robots fabricados por Cincinatti Milacron (figura 1.4) emplea 
una muñeca con tres ejes que se intersecan pero que no son ortogonales. En este dise¬ 
ño (llamado “muñeca de triple balanceo”), las tres articulaciones de la muñeca pueden 
girar continuamente sin límites. Sin embargo, el hecho de que los ejes no sean ortogo¬ 
nales crea un conjunto de orientaciones que son imposibles de alcanzar con esta muñe¬ 
ca. Este conjunto de orientaciones inalcanzables se describe mediante un cono dentro 
del cual no puede estar el tercer eje de la muñeca. (Vea el ejercicio 8.11.) Sin embargo, 
la muñeca puede montarse en el vínculo 3 del manipulador de tal forma que la estruc¬ 
tura de los vínculos ocupe este cono, por lo que se bloquearía el acceso de todas for¬ 
mas. La figura 8.9 muestra dos dibujos de dicha muñeca [24], 

Algunos robots industriales tienen muñecas que no tienen ejes que se interse¬ 
quen. Esto implica que tal vez no exista una solución cinemática de forma cerrada. No 
obstante, si la muñeca está montada en un manipulador articulado de tal forma que el 
eje de la articulación 4 sea paralelo a los ejes de las articulaciones 2 y 3, como en la fi¬ 
gura 8.10, sí habrá una solución cinemática de forma cerrada. De igual forma, una mu¬ 
ñeca con ejes que no se intersequen, que esté montada en un robot cartesiano, permite 
que el manipulador pueda resolverse de forma cerrada. 

Generalmente, los robots 5-DOF para soldar utilizan muñecas con dos ejes orien¬ 
tadas como se muestra en la figura 8.11. Observe que si el robot tiene una herramienta 
simétrica, esta “articulación ficticia” debe seguir las reglas del diseño de las muñecas. 
Esto significa que, para llegar a todas las orientaciones, la herramienta debe estar mon¬ 
tada con su eje de simetría ortogonal al eje de la articulación 5. En el peor de los ca¬ 
sos, cuando el eje de simetría es paralelo al eje de la articulación 5, el sexto eje ficticio 
se encuentra en una configuración permanentemente singular. 




FIGURA 8.9: Dos vistas de una muñeca con eje no ortogonal. De International Encyclo- 
pedia of Robotics, por R. Dorf y S. Nof (editores). De “Wrists” por M. Rosheim, John 
C. Wiley and Sons, Inc., NuevaYork, NY ©1988. Reimpreso con permiso. 




































Sección 8.4 


Medidas cuantitativas de atributos del espacio de trabajo 


239 



FIGURA 8.10: Un manipulador con una muñeca cuyos ejes no se intersecan. Sin embar¬ 
go, este robot posee una solución cinemática de forma cerrada. 



FIGURA 8.11: Diseño típico de muñeca de un robot 5-DOF para soldar. 


8.4 MEDIDAS CUANTITATIVAS DE ATRIBUTOS DEL ESPACIO DE TRABAJO 

Los diseñadores de manipuladores han propuesto varias medidas cuantitativas intere¬ 
santes de varios atributos de los espacios de trabajo. 











240 Capítulo 8 


Diseño del mecanismo del manipulador 


Eficiencia del diseño en términos de la generación del espacio de trabajo 

Algunos diseñadores se dieron cuenta de que parecía necesitarse más material para 
construir un manipulador cartesiano que para construir un manipulador articulado con 
un volumen similar de espacio de trabajo. Para darnos una idea cuantitativa, primero 
definiremos la suma de longitud de un manipulador, como 

N 

¿ 1 + 4), (8.1) 

i =1 

en donde a i X y d i son la longitud de vínculo y el desplazamiento de vínculo, según se 
definieron en el capítulo 3. En consecuencia, la suma de longitud de un manipulador 
nos da una medida aproximada de la “longitud” de todos los vínculos. Observe que pa¬ 
ra las articulaciones prismáticas, d¡ debe interpretarse aquí como una constante igual a 
la longitud de recorrido entre los límites del recorrido de las articulaciones. 

En [3] el índice de longitud estructural Q L se define como el cociente de la suma de 
longitud del manipulador y la raíz cúbica del volumen del espacio de trabajo; esto es, 

Ql = L/Vw, (8.2) 


en donde L se da en la ecuación (8.1) y W es el volumen del espacio de trabajo del ma¬ 
nipulador. Por lo tanto, Q L intenta indizar la cantidad relativa de estructura (longitud 
de vínculos) requerida por distintas configuraciones para generar un volumen de tra¬ 
bajo dado. En consecuencia, un buen diseño sería aquel en el que un manipulador con 
una pequeña suma de longitud tuviera, sin embargo, un volumen grande de espacio de 
trabajo. Los buenos diseños tienen una Q L baja. 

Si consideramos sólo la estructura de colocación de un manipulador cartesiano (y 
por lo tanto el espacio de trabajo del punto de la muñeca), el valor de Q L se minimiza 
cuando las tres articulaciones tienen la misma longitud de recorrido. Este valor mínimo es 
Q l — 3.0. Por otra parte, un manipulador articulado ideal como el de la figura 8.4 tiene 


Ql 


= 0.62. Esto ayuda a cuantificar nuestra anterior declaración de que los 


manipuladores articulados son superiores a otras configuraciones, ya que tienen una mí¬ 
nima intrusión en su propio espacio de trabajo. Desde luego, que en cualquier estructu¬ 
ra de un manipulador real, el número que acabamos de dar se haría algo más grande por 
el efecto de los límites de articulación, al reducir el volumen del espacio de trabajo. 


EJEMPLO 8.1 

Un manipulador SCARA, como el de la figura 8.5, tiene los vínculos 1 y 2 de igual lon¬ 
gitud, representada por 7/2, y el rango de movimiento de la articulación prismática 3 está 
dado por d y Suponga por simplicidad que los límites de las articulaciones están ausen¬ 
tes, y encuentre Q L . ¿Qué valor de d¿ minimiza Q L y cuál es este valor mínimo? 

La suma de longitud de este manipulador es L — 7/2 + 7/2 + d 3 = l + d v y el volu¬ 
men del espacio de trabajo es el de un cilindro recto de radio / y altura d y por lo tanto, 

Q l = (83) 

$nl 2 <h 

Si minimizamos Q L como una función de la proporción dJI obtenemos d 3 = 1/2 como 
valor óptimo [3]. El valor mínimo correspondiente de Q L sería 1.29. 







Sección 8.5 Estructuras redundantes y de cadena cerrada 241 

Diseño de espacios de trabajo bien condicionados 

En puntos singulares, un manipulador pierde efectivamente uno o más grados de liber¬ 
tad, por lo que tal vez no pueda realizar ciertas tareas en esos puntos. De hecho, en las 
proximidades de los puntos singulares (incluyendo las singularidades en los límites del 
espacio de trabajo), las acciones del manipulador podrían dejar de estar bien condicio¬ 
nadas. En cierto sentido, entre más alejado esté el manipulador de las singularidades 
podrá moverse mejor de manera uniforme y podrá aplicar fuerzas uniformemente en to¬ 
das las direcciones. Se han sugerido varias medidas para cuantificar este efecto. El uso de 
dichas medidas en tiempo de diseño podría producir un diseño de manipulador con un 
subespacio bien condicionado del espacio de trabajo con el mayor tamaño posible. 

Las configuraciones singulares se dan mediante 

det(/(©)) = 0, (8.4) 

por lo tanto, es natural utilizar el determinante del jacobiano en una medida de la des¬ 
treza del manipulador. En [4], la medida de manipulabilidad w se define como 

w = Vdet( J(@)J T (@)), (8.5) 

que para un manipulador no redundante se reduce a 

w = |det(/(©))|. (8.6) 

Un buen diseño de manipulador tiene grandes áreas de su espacio de trabajo caracte¬ 
rizadas por altos valores de w. 

Mientras que el análisis de velocidad motivó la ecuación (8.6), otros investigado¬ 
res han propuesto medidas de manipulabilidad basadas en el análisis de aceleración o 
en la capacidad de aplicación de fuerza. Asada [5] sugirió un examen de los valores pro¬ 
pios de la matriz de masas cartesiana 

M v (0) = /“ 7 ’(©)M(0)7“ 1 (0) (8.7) 

como una medida de qué tan bien puede acelerar el manipulador en varias direcciones 
cartesianas; él sugiere una representación gráfica de esta medida como un elipsoide de 
inercia dado por 

X T M x (@)X = 1, (8.8) 

que es la ecuación de una elipse «-dimensional, en donde n es la dimensión de X. Los 
ejes del elipsoide dados en la ecuación (8.8) yacen en las direcciones de los vectores 
propios de y los recíprocos de las raíces cuadradas de los valores propios co¬ 

rrespondientes proveen las longitudes de los ejes en el elipsoide. Los puntos bien con¬ 
dicionados en el espacio de trabajo del manipulador se caracterizan por elipsoides de 
inercia que son esféricos (o que casi lo son). 

La figura 8.12 muestra gráficamente las propiedades de un manipulador planar de 
dos vínculos. En el centro del espacio de trabajo, el manipulador está bien condicionado, 
como se indica mediante elipsoides casi circulares. En los límites del espacio de traba¬ 
jo las elipses se aplanan, indicando la dificultad del manipulador para acelerar en cier¬ 
tas direcciones. 

En [6-8, 25] se han propuesto otras medidas de condicionamiento del espacio de 
trabajo. 

8.5 ESTRUCTURAS REDUNDANTES Y DE CADENA CERRADA 

El alcance de este libro está limitado a los manipuladores que están formados por conjun¬ 
tos de vínculos de cadena serial de seis o menos articulaciones. No obstante, en esta sec¬ 
ción hablaremos brevemente sobre los manipuladores que no pertenecen a esta clase. 
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FIGURA 8.12: El espacio de trabajo de un brazo planar 2-DOF, mostrando los elipsoides 
de inercia, de [5] (©1984 IEEE). La línea punteada indica un lugar de puntos isotrópi- 
cos en el espacio de trabajo. Reimpresa con permiso. 


Micromanipuladores y otras redundancias 

La capacidad de posicionamiento espacial general requiere solamente de seis grados de 
libertad, pero existen ventajas al tener articulaciones aún más controlables. 

Uno de los usos para estas libertades adicionales ya tiene cierta aplicación práctica 
[9,10], además de que es cada vez más interesante para la comunidad de investigación: un 
micromanipulador. Generalmente un micromanipulador está formado por varios grados, 
rápidos y precisos, de libertad ubicados cerca del extremo distal de un manipulador “con¬ 
vencional”. Este manipulador convencional se encarga de los movimientos extensos, 
mientras que el micromanipulador, cuyas articulaciones por lo general tienen un rango de 
movimiento más pequeño, realiza el movimiento fino y el control de la fuerza. 

Como se sugiere en [11, 12], las articulaciones adicionales también pueden ayu¬ 
dar a que un mecanismo evite las configuraciones singulares, por ejemplo, cualquier 
muñeca con tres grados de libertad sufrirá de configuraciones singulares (cuando los 
tres ejes estén sobre un plano), pero una muñeca con cuatro grados de libertad puede 
evitar efectivamente dichas configuraciones [13-15]. 

La figura 8.13 muestra dos configuraciones sugeridas [11,12] para los manipula¬ 
dores con siete grados de libertad. 

Un uso importante de los robots redundantes es para evitar colisiones mientras se 
opera en entornos de trabajo llenos de obstáculos. Como hemos visto, un manipulador con 
seis grados de libertad puede llegar a una posición y orientación dadas en un número de¬ 
terminado de maneras. La adición de una séptima articulación permite un número infini¬ 
to de formas, lo que hace que la necesidad de evitar obstáculos influya en la decisión. 

Estructuras de lazo cerrado 

Aunque hemos considerado sólo manipuladores de cadena serial en nuestro análisis, algu¬ 
nos manipuladores contienen estructuras de lazo cerrado. Por ejemplo, el robot Motoman 
L-3 descrito en los capítulos 3 y 4 posee estructuras de lazo cerrado en el mecanismo de 
control de las articulaciones 2 y 3. Las estructuras de lazo cerrado ofrecen un beneficio: un 
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FIGURA 8.13: Dos diseños sugeridos de manipulador con siete grados de libertad [3]. 

aumento en la rigidez del mecanismo [16]. Por otro lado, las estructuras de lazo cerrado 
generalmente reducen el rango permisible de movimiento de las articulaciones y, por en¬ 
de, reducen el tamaño del espacio de trabajo. 

En la figura 8.14 se muestra un mecanismo Stewart, una alternativa de lazo cerra¬ 
do para el manipulador 6-DOF serial. La posición y la orientación del “efector final” 
se controlan mediante las longitudes de los seis actuadores lineales que lo conectan a la 
base, en cuyo extremo cada actuador está conectado por una articulación universal con 
dos grados de libertad. En el efector final, cada actuador está unido con una articula¬ 
ción cotiloidea (es decir, de “bola y ranura”) de tres grados de libertad. Exhibe carac¬ 
terísticas comunes a la mayoría de los mecanismos de lazo cerrado: puede hacerse muy 
rígido, pero los vínculos tienen un rango de movimiento mucho más limitado que los 
vínculos seriales. Específicamente, el mecanismo Stewart demuestra una reversión in¬ 
teresante en la naturaleza de las soluciones cinemáticas directa e inversa: la solución 
inversa es considerablemente simple, mientras que la solución directa es por lo común 
bastante compleja, y algunas veces carece de una formulación de forma cerrada. (Vea los 
ejercicios 8.7 y 8.12). 

En general, el número de grados de libertad de un mecanismo de lazo cerrado no 
es obvio y puede calcularse mediante la fórmula de Grübler [17], 


n 



(8.9) 


¡= l 


en donde F es el número total de grados de libertad en el mecanismo, / es el número de 
vínculos (incluyendo la base), n es el número total de articulaciones y es el número 
de grados de libertad asociados con la í-ésima articulación. Una versión en dos dimen¬ 
siones de la fórmula de Grübler (cuando se considera que todos los objetos tienen tres 
grados de libertad si no hay restricciones) se obtiene sustituyendo el 6 en la ecuación 
(8.9) con un 3. 
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FIGURA 8.14: El mecanismo Stewart es un manipulador de seis grados de libertad com¬ 
pletamente paralelo. 


EJEMPLO 8.2 

Utilice la fórmula de Grübler para verificar que el mecanismo Stewart (figura 8.14) 
realmente tenga seis grados de libertad. 

El número de articulaciones es de 18 (6 universales, 6 cotiloideas y 6 prismáticas 
en los actuadores). El número de vínculos es 14 (2 piezas para cada actuador, el efec- 
tor final y la base). La suma de todos los grados de libertad de las articulaciones es de 
36. Utilizando la fórmula de Grübler, podemos verificar que el número total de grados 
de libertad es de seis: 


E = 6(14-18-1)+ 36 = 6. 


( 8 . 10 ) 


8.6 ESQUEMAS DE ACCIONAMIENTO 

Una vez elegida la estructura cinemática general de un manipulador, el siguiente aspecto 
más importante es el accionamiento de las articulaciones. Por lo general, el actuador, la re¬ 
ducción y la transmisión están estrechamente acoplados y deben diseñarse en conjunto. 

Ubicación del actuador 

La elección más simple para la ubicación del actuador es en la articulación que contro¬ 
la o cerca de ella. Si el actuador puede producir suficiente momento de torsión o fuer¬ 
za, su salida puede unirse directamente a la articulación. Este arreglo, conocido como 
configuración de control directo [18], ofrece las ventajas de simplicidad en el diseño y 
capacidad de control superior; esto es, sin elementos de transmisión o de reducción entre 
el actuador y la articulación, los movimientos de la articulación pueden controlarse con 
la misma fidelidad que el mismo actuador. 
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Por desgracia, muchos actuadores están mejor adaptados a velocidades relativa¬ 
mente altas y momentos de torsión bajos, por lo cual requieren de un sistema de reduc¬ 
ción de velocidad. Además, los actuadores tienden a ser demasiado pesados. Si pueden 
ubicarse apartados de la articulación y hacia la base del manipulador, la inercia total de 
éste podrá reducirse considerablemente. Esto a su vez reduce el tamaño necesario pa¬ 
ra los actuadores. Para obtener estos beneficios se necesita un sistema de transmisión 
para transferir el movimiento del actuador a la articulación. 

En un sistema de control de articulaciones con un actuador montado en forma re¬ 
mota, el sistema de reducción podría colocarse tanto en el actuador como en la articu¬ 
lación. Algunos arreglos combinan las funciones de transmisión y reducción. Aparte 
del aumento en la complejidad, la principal desventaja de los sistemas de reducción y 
transmisión es que introducen más fricción y flexibilidad en el mecanismo. Cuando la 
reducción es en la articulación, la transmisión estará trabajando a velocidades mayores 
y momentos de torsión más bajos. Un momento de torsión más bajo significa que la fle¬ 
xibilidad será un problema menos. No obstante, si el peso del reductor es considerable, 
se perderá algo de la ventaja de tener los actuadores montados en forma remota. 

En el capítulo 3 se dieron los detalles para el esquema de accionamiento del Yasu- 
kawa Motoman L-3, que tiene el típico diseño en el que los actuadores están montados 
en forma remota y los movimientos resultantes de las articulaciones están acoplados. Las 
ecuaciones (3.16) muestran explícitamente cómo los movimientos del actuador pueden 
causar movimientos de la articulación. Por ejemplo, observe que el movimiento del ac¬ 
tuador 2 produce el movimiento de las articulaciones 2, 3 y 4. 

La distribución óptima de las etapas de reducción a lo largo de la transmisión 
dependerá en última instancia de la flexibilidad de la transmisión, del peso del sistema de 
reducción, de la fricción asociada con el sistema de reducción y de la facilidad para in¬ 
corporar estos componentes en el diseño del manipulador en general. 

Sistemas de reducción y de transmisión 

Los engranajes son el elemento más común utilizado para la reducción. Pueden producir 
grandes reducciones en configuraciones relativamente compactas. Los pares de engrana¬ 
jes vienen en varias configuraciones para ejes paralelos (engranajes rectos), ejes ortogona¬ 
les que se intersecan (engranajes cónicos), ejes oblicuos (engranajes de tornillos sinfín o 
engranajes helicoidales cruzados), entre otras. Los distintos tipos de engranajes tienen di¬ 
ferentes clasificaciones de carga, características de desgaste y propiedades fricciónales. 

Las principales desventajas de usar engranajes son un aumento en el efecto re¬ 
troactivo y en la fricción. El efecto retroactivo, que se produce debido a que los engra¬ 
najes no encajan correctamente, puede definirse como el máximo movimiento angular 
de los engranajes de salida cuando el engranaje de entrada permanece fijo. Si los dien¬ 
tes del engranaje encajan firmemente para eliminar el efecto retroactivo, puede haber 
cantidades excesivas de fricción. Un engranaje y montaje muy precisos minimizan es¬ 
tos problemas, pero también aumentan el costo. 

La proporción del engranaje i] describe los efectos de reducción de velocidad y 
aumento en el momento de torsión de un par de engranajes. Para los sistemas de re¬ 
ducción de velocidad definiremos r¡ > 1; por lo que las relaciones entre las velocidades 
y los momentos de torsión de entrada y salida se dan mediante 

é 0 = a m 

= 


r, 


( 8 . 11 ) 
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en donde 0 o y Q¡ son las velocidades de salida y de entrada, respectivamente, y r o y T¡ los 
momentos de torsión de salida y entrada correspondientes. 

La segunda clase extensa de elementos de reducción incluye bandas flexibles, ca¬ 
bles y correas. Como todos estos elementos deben ser lo suficientemente flexibles 
como para doblarse alrededor de las poleas, también tienden a ser flexibles en la direc¬ 
ción longitudinal. La flexibilidad de estos elementos es proporcional a su longitud, y 
dado que estos sistemas son flexibles, debe haber algún mecanismo para cargar previa¬ 
mente el lazo y asegurarse de que la banda o el cable permanezcan enganchados en la 
polea. Las cargas previas grandes pueden agregar una tensión indebida al elemento fle¬ 
xible e introducir una fricción excesiva. 

Los cables o bandas flexibles pueden usarse en un lazo cerrado o como elemen¬ 
tos de un solo extremo que siempre se mantienen en tensión mediante cierto tipo de 
carga previa. En una articulación que es accionada por resorte en una dirección podría 
usarse un cable de un solo extremo para jalarla. Como alternativa, dos sistemas activos 
de un solo extremo pueden oponerse uno al otro. Este arreglo elimina el problema de 
cargas previas excesivas, pero agrega más actuadores. 

Las cadenas de rodillos son similares a las bandas flexibles, pero pueden doblar¬ 
se alrededor de poleas relativamente pequeñas al mismo tiempo que conservan una al¬ 
ta rigidez. Como resultado del desgaste y de cargas pesadas en los pernos que conectan 
los vínculos, los sistemas con bandas dentadas son más compactos que las cadenas de 
rodillos para ciertas aplicaciones. 

Las transmisiones de banda, cable, correa y cadena tienen la habilidad de combi¬ 
nar la transmisión con la reducción. Como se muestra en la figura 8.15, cuando la po¬ 
lea de entrada tiene un radio r 1 y la de salida un radio r 2 , la proporción de “engranaje” 
del sistema de transmisión es 



( 8 . 12 ) 


Los tornillos de posicionamiento, o los de cojinete tipo bola son otro método popu¬ 
lar para obtener una gran reducción en un paquete compacto (figura 8.16). Los tornillos 
de posicionamiento son muy rígidos y pueden soportar cargas muy grandes; además tie¬ 
nen la propiedad de que transforman el movimiento giratorio en movimiento lineal. Los 
tornillos de cojinete tipo bola son similares a los de posicionamiento, pero en vez de que 
las roscas de las tuercas se monten directamente en las roscas de los tornillos, un circuito 
recirculante de cojinetes tipo bola rueda entre los conjuntos de roscas. Los tornillos de co¬ 
jinete tipo bola tienen muy baja fricción y por lo general cuentan con arranque trasero. 



Entrada 


Salida 


FIGURA 8.15: Las transmisiones de banda, cable, correa y cadena tienen la habilidad de 
combinar la transmisión con la reducción. 
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FIGURA 8.16: Los tornillos de posicionamiento (a) y los tomillos de cojinete tipo bola 
(b) combinan una gran reducción con la transformación de movimiento giratorio en 
movimiento lineal. 

8.7 RIGIDEZ Y DEFLEXIONES 

Un objetivo importante en el diseño de la mayoría de los manipuladores es la rigidez 
total de la estructura y el sistema de control. Los sistemas rígidos tienen dos beneficios 
importantes: En primer lugar, como los manipuladores comunes no tienen sensores pa¬ 
ra medir directamente la ubicación de la trama herramienta, ésta se calcula utilizando 
la cinemática directa con base en las posiciones detectadas de las articulaciones. Para 
un cálculo preciso, los vínculos no pueden pandearse por la gravedad u otras cargas. En 
otras palabras, deseamos que nuestra descripción Denavit-Hartenberg de los vínculos 
permanezca fija bajo varias condiciones de carga. En segundo lugar, las flexibilidades 
en la estructura o el tren de transmisión producirán resonancias, las cuales tienen un 
efecto indeseable en el desempeño de un manipulador. En esta sección consideraremos 
las cuestiones de rigidez y las deflexiones resultantes bajo cargas. Pospondremos para 
el capítulo 9 una discusión más detallada de las resonancias. 

Elementos flexibles en paralelo y en serie 

Como puede mostrarse fácilmente (vea el ejercicio 8.21), la combinación de dos miembros 
flexibles de rigidez y k 2 “conectados en paralelo” produce la siguiente rigidez neta: 


^paralelo ^1 "b ^2> 


(8.13) 


“conectados en serie”, la combinación produce la siguiente rigidez neta: 



(8.14) 


Al considerar los sistemas de transmisión, a menudo tenemos el caso de una eta¬ 
pa de reducción o de transmisión en serie con una etapa subsiguiente de reducción o de 
transmisión; por lo tanto la ecuación (8.14) se vuelve útil. 

Ejes 

Un método común para transmitir el movimiento giratorio es a través de ejes. La rigi¬ 
dez torsional de un eje redondo puede calcularse [19] así: 


Gnd 4 


k = 


32/ ’ 


(8.15) 
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en donde d es el diámetro del eje, / es su longitud y G es el módulo de elasticidad trans¬ 
versal (aproximadamente 7.5 x 10 10 Nt/m 2 para el acero, y un tercio de esa cantidad pa¬ 
ra el aluminio). 

Engranajes 

Aunque por lo general los engranajes son bastante rígidos, agregan elasticidad en el sis¬ 
tema de accionamiento. Una fórmula aproximada para estimar la rigidez del engrana¬ 
je de salida (suponiendo que el engranaje de entrada sea fijo) se da en [20] como 

k = Cgbr 2 , (8-16) 

en donde b es la anchura lateral de los engranajes, r es el radio del engranaje de salida 
y C g = 1.34 x 10 10 Nt/m 2 para el acero. 

Los engranajes también tienen el efecto de cambiar la rigidez efectiva del sistema 
de control por un factor de if. Si la rigidez del sistema de transmisión antes de la re¬ 
ducción (es decir, en el lado de entrada) es k p de manera que 

= k¡86¡, (8.17) 

y la rigidez del lado de salida de la reducción es k , de manera que 

r o = k 0 se 0 , (8.18) 

entonces podemos calcular la relación entre k¡ y k (bajo la suposición de un par de en¬ 
granajes perfectamente rígidos) como 


k 


O 


se n 


= „ 2 / c 

a/r¡)se¡ 


(8.19) 


Por lo tanto, una reducción de engranajes tiene el efecto de aumentar la rigidez según 
el cuadrado de la proporción de los engranajes. 


EJEMPLO 8.3 

Un eje con una rigidez torsional igual a 500.0 Nt-m/radián está conectado del lado de 
entrada de un conjunto de engranajes con r¡ = 10, cuyo engranaje de salida (cuando el 
de entrada es fijo) exhibe una rigidez de 5000.0 Nt-m/radián. ¿Cuál es la rigidez de sa¬ 
lida del sistema de accionamiento combinado? 

Con las ecuaciones (8.14) y (8.19) tenemos que 

111 

k~ ~ 5000.0 + 10 2 (500.0)’ ( 8 ‘ 2 °^ 


o 


& S erie = ——— = 4545.4 Nt m/radian (8.21) 

Cuando una reducción de velocidad relativamente grande es el último elemento de un 
sistema de transmisión con múltiples elementos, la rigidez de los elementos anteriores 
por lo general puede ignorarse. 
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FIGURA 8.17: Una simple viga voladiza utilizada para modelar la rigidez de un vínculo 
a una carga en el extremo. 


Correas 

En una transmisión de correa tal como la de la figura 8.15, la rigidez se obtiene mediante 


k 


\ / 


( 8 . 22 ) 


en donde A es el área de corte transversal de la correa, E es el módulo de elasticidad y l 
la longitud libre entre las poleas, más un tercio de la longitud de la correa que está en 
contacto con las poleas [19]. 


Vínculos 


Como una aproximación de la rigidez de un vínculo, podríamos modelar un vínculo in¬ 
dividual como una viga voladiza y calcular la rigidez en el punto extremo, como en la 
figura 8.17. Para una viga hueca redonda, esta rigidez se obtiene mediante [19] 


3nE(d 4 — d 4 ) 

_ O _ l__ 

64/ 3 


(8.23) 


en donde í?. y d o son los diámetros interno y externo de la viga tubular, l es longitud y 
E el módulo de elasticidad (aproximadamente 2 x 10 n Nt/m 2 para el acero y un tercio 
de esa cantidad para el aluminio). Para una viga hueca de corte cuadrado transversal, 
esta rigidez se obtiene mediante 


k = 


E(w 4 - w 4 ) 

O _/__ 

4/3 


(8.24) 


en donde w ¡ y w a son las anchuras interior y exterior de la viga (es decir, el grosor de 
pared es w Q — w¡). 


EJEMPLO 8.4 

Un vínculo de corte transversal cuadrado de 5 x 5 x 50 cm, con un grosor de pared de 
1 cm, es controlado por un conjunto de engranajes rígidos con r¡ — 10, y la entrada de los 
engranajes está controlada por un eje con un diámetro de 0.5 cm y una longitud de 30 cm. 
¿Cuál es la deflexión ocasionada por una fuerza de 100 Nt en el extremo del vínculo? 












250 Capítulo 8 


Diseño del mecanismo del manipulador 


Si utilizamos la ecuación (8.24) podemos calcular la rigidez del vínculo como 

(8.25) 


, (2 x 10 11 )(0.05 4 - 0.04 4 ) ia5 

^-vínculo - -- - — 3.69 X 10 . 


4(0.5) 

En consecuencia, para una carga de 100 Nt hay una deflexión en el mismo vínculo de 


Sx = 


100 

^vínculo 


= 2.7 x 10“ 4 m, 


(8.26) 


o 0.027 cm. 

Además, los 100 Nt en el extremo de un vínculo de 50 cm están aplicando un mo¬ 
mento de torsión de 50 Nt-m en el engranaje de salida. Los engranajes son rígidos, pe¬ 
ro la flexibilidad del eje de entrada es 


h — 

eje 


(7.5 X 10 10 )(3.14)(5 X 10 -3 ) 4 
(32)(0.3) 


= 15.3 Nt m/radian 


(8.27) 


lo cual, visto desde el engranaje de salida es 

k'. = (15.3) (10 2 ) = 1530.0 Nt-m/radian (8.28) 

eje 

Si se carga con 50 Nt-m se produce una deflexión angular de 

S6 = i5 ^ Q ° o = 0.0326 radian (8.29) 

por lo que la deflexión lineal total en la punta del vínculo sería 

Sx = 0.027 + (0.0326)(50) = 0.027 + 1.630 = 1.657 cm. (8.30) 

En nuestra solución hemos supuesto que el eje y el vínculo están hechos de acero. La ri¬ 
gidez de ambos miembros es lineal en E, el módulo de elasticidad, por lo que para los ele¬ 
mentos de aluminio podemos multiplicar nuestro resultado por 3 (aproximadamente). 


En esta sección hemos examinado ciertas fórmulas simples para estimar la rigidez 
de los engranajes, ejes, correas y vínculos. El propósito de estas fórmulas es obtener cier¬ 
tos lincamientos para definir el tamaño de los miembros estructurales y los elementos de 
transmisión. No obstante, en aplicaciones prácticas muchas fuentes de flexibilidad son 
muy difíciles de modelar. A menudo el tren de transmisión introduce una flexibilidad 
considerablemente mayor que el vínculo de un manipulador. Además, aquí no hemos con¬ 
siderado muchas fuentes de flexibilidad (de los cojinetes, del montaje del actuador, 
etc.) en el sistema de control. Generalmente cualquier intento de predecir la rigidez en 
forma analítica genera una predicción excesivamente alta, ya que no se consideran mu¬ 
chas fuentes. 

Pueden utilizarse técnicas de elementos finitos para predecir con más precisión la 
rigidez (y otras propiedades) de elementos estructurales más realistas. Este es todo un 
campo por sí solo [21] y está más allá del alcance de este libro. 

Actuadores 

De entre varios actuadores, los cilindros hidráulicos o actuadores de álabe eran origi¬ 
nalmente los más populares para utilizarse en los manipuladores. En un paquete 







Sección 8.7 


Rigidez y deflexiones 251 


relativamente compacto pueden producir suficiente fuerza para controlar las articula¬ 
ciones sin un sistema de reducción. La velocidad de operación depende del sistema de 
bomba y acumulador, que por lo general se ubica lejos del manipulador. El control 
de posición de un sistema hidráulico es bien conocido y relativamente simple. Los pri¬ 
meros robots industriales y muchos robots industriales modernos de gran tamaño utili¬ 
zaron o utilizan actuadores hidráulicos. 

Desafortunadamente la hidráulica requiere una gran cantidad de equipo, como 
bombas, acumuladores, mangueras y servo válvulas. Los sistemas hidráulicos también 
tienden a ser inherentemente desordenados, lo que los hace inadecuados para ciertas 
aplicaciones. Con la llegada de estrategias de control de robots más avanzadas, en las que 
las fuerzas de los actuadores deben aplicarse con precisión, la hidráulica está en des¬ 
ventaja debido a la fricción contribuida por sus obturaciones. 

Los cilindros neumáticos poseen todos los atributos favorables de la hidráulica, 
además de que son más limpios (expelen aire en vez de fluido hidráulico). No obstan¬ 
te, los actuadores neumáticos son difíciles de controlar con precisión debido a la com¬ 
presibilidad del aire y la alta fricción de las obturaciones. 

Los motores eléctricos son el tipo de actuador más popular para los manipulado¬ 
res y, aunque no tienen la proporción de energía-peso de sus contrapartes hidráulicas o 
neumáticas, su capacidad de control y fácil interconexión los hace atractivos para ma¬ 
nipuladores de tamaño pequeño o mediano. 

Los motores con escobillas de corriente directa (CD) (figura 8.18) son los más sim¬ 
ples de coordinar y controlar. La corriente se conduce hacia los devanados del rotor me¬ 
diante escobillas, las cuales hacen contacto con el conmutador giratorio; pero el desgaste 
y la fricción de éstas puede ocasionar problemas. Los nuevos materiales magnéticos han 
hecho posible obtener momentos de torsión máximos elevados. El factor limitante en la 
producción del momento de torsión de estos motores es el sobrecalentamiento de los 



FIGURA 8.18: Los motores de escobillas de CD están entre los actuadores que se utili¬ 
zan con más frecuencia en el diseño de manipuladores. Franklin, Powell, Enami-Naei- 
ni, Feedback Control of Dynamic Systems, ©1988, Addison-Wesley, Reading, MA. 
Reimpreso con permiso. 
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devanados. En ciclos cortos pueden lograrse momentos de torsión elevados, pero duran¬ 
te periodos largos sólo pueden sostenerse momentos de torsión mucho menores. 

Los motores sin escobillas solucionan los problemas de desgaste y fricción de las 
escobillas. Aquí los devanados permanecen fijos y la pieza del campo magnético gira. Un 
sensor en el rotor detecta el ángulo del eje y es utilizado por los componentes electró¬ 
nicos externos para realizar la conmutación. Otra ventaja de los motores sin escobillas 
es que el devanado está en el exterior, unido a la cubierta del motor, lo que permite un 
mejor enfriamiento. Los valores sostenidos del momento de torsión tienden a ser algo 
más altos que para los motores con escobillas de tamaño similar. 

Los motores de corriente alterna (CA) y los motores de pasos se han utilizado con 
poca frecuencia en la robótica industrial. La dificultad de control de los primeros y la 
baja capacidad para generar momento de torsión de los segundos han limitado su uso. 

8.8 DETECCIÓN DE POSICIÓN 

Casi todos los manipuladores son mecanismos servo-controlados; esto es, el comando 
de fuerza o de momento de torsión para un actuador está basado en el error entre la 
posición detectada de la articulación y la posición deseada. Para ello se requiere que 
cada articulación tenga algún tipo de dispositivo detector de posición. 

El método más común es ubicar un sensor de posición directamente en el eje del 
actuador. Si el tren de transmisión es rígido y no tiene holgura, los ángulos de articula¬ 
ción reales pueden calcularse a partir de las posiciones del eje del actuador. Dichos pa¬ 
res de sensor y actuador coubicados son los más fáciles de controlar. 

El dispositivo de retroalimentación de posición más popular es el codificador óp¬ 
tico giratorio. A medida que gira el eje del codificador, un disco que contiene un patrón 
de líneas interrumpe un haz de luz. Un fotodetector convierte estos pulsos de luz en 
una forma de onda binaria. Generalmente hay dos de tales canales, con trenes de pul¬ 
so de onda desfasados 90 grados. El ángulo del eje se determina contando el número 
de pulsos, y la dirección de rotación se determina mediante la fase relativa de las dos 
ondas cuadradas. Además, los codificadores generalmente emiten un pulso índice en 
una ubicación que puede usarse para establecer una posición inicial y poder calcular una 
posición angular absoluta. 

Los resolventes son dispositivos que producen dos señales análogas; una es el se¬ 
no del ángulo del eje, la otra es el coseno. El ángulo del eje se calcula a partir de la mag¬ 
nitud relativa de las dos señales; la resolución es una función de la calidad del 
resolvente y la cantidad de ruido absorbido en los componentes electrónicos y el ca¬ 
bleado. Los resolventes son a menudo más confiables que los codificadores ópticos, 
pero su resolución es menor. Generalmente los resolventes no pueden colocarse direc¬ 
tamente en la articulación sin engranaje adicional para mejorar la resolución. 

Los potenciómetros son la forma más simple de detección de posición. Al co¬ 
nectarse en configuración de puente producen un voltaje proporcional a la posición 
del eje; pero las dificultades con la resolución, linealidad y susceptibilidad al ruido li¬ 
mitan su uso. 

Algunas veces, los tacómetros se utilizan para proporcionar una señal análoga 
proporcional a la velocidad del eje. En ausencia de dichos sensores de velocidad, la re¬ 
troalimentación de velocidad se deriva tomando diferencias de la posición detectada 
en el tiempo. Esta diferenciación numérica puede introducir tanto ruido como un re¬ 
traso de tiempo. A pesar de estos problemas potenciales, la mayoría de los manipu¬ 
ladores no tienen una detección directa de la velocidad. 
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8.9 DETECCIÓN DE FUERZA 

Existe una gran variedad de dispositivos para medir las fuerzas de contacto entre el 
efector final de un manipulador y el entorno con el que interactúa. La mayoría de 
dichos sensores utiliza elementos de detección llamados indicadores de tensión, ya sea 
la variedad de semiconductor o la de laminilla de metal. Estos indicadores de tensión 
están enlazados a una estructura de metal y producen una salida proporcional a la ten¬ 
sión en el metal. En este tipo de diseño de detector de fuerza, los puntos con los que 
debe tratar el diseñador son: 

1. ¿Cuántos sensores se necesitan para resolver la información deseada? 

2. ¿Cómo están montados los sensores de forma relativa unos con otros en la estructura? 

3. ¿Qué estructura permite una buena sensibilidad, manteniendo al mismo tiempo 
la rigidez? 

4. ¿Cómo puede integrarse la protección contra sobrecarga mecánica en el dispositivo? 
Hay tres lugares en los que generalmente se colocan esos sensores en un manipulador: 

1. En los actuadores de las articulaciones. Estos sensores miden la salida del momen¬ 
to de torsión o fuerza del actuador/reducción. Son útiles para algunos esquemas de 
control, pero generalmente no proporcionan una buena detección del contacto en¬ 
tre el efector final y el entorno. 

2. Entre el efector final y la última articulación del manipulador. Estos sensores, co¬ 
nocidos comúnmente como sensores de muñeca, son estructuras mecánicas equipa¬ 
das con indicadores de tensión, los cuales pueden medir las fuerzas y momentos de 
torsión que actúan sobre el efector final. Generalmente estos sensores son capaces 
de medir de tres a seis componentes del vector de fuerza/momento de torsión que 
actúa sobre el efector final. 

3. En la “punta de los dedos” del efector final. Generalmente estos dedos detecto¬ 
res de fuerza tienen indicadores de tensión integrados para medir de uno a cua¬ 
tro componentes de fuerzas que actúen en la punta de cada dedo. 

El dibujo de la figura 8.19 es un ejemplo de la estructura interna de un popular es¬ 
tilo de sensor de fuerza de muñeca diseñado por Scheinman [22]. Hay ocho pares de ca¬ 
libradores de deformación del tipo semiconductor enlazados a la estructura de barra 
cruzada del dispositivo. Cada par está cableado en un arreglo de divisor de voltaje. Cada 
vez que se consulta la muñeca, se digitalizan y leen en la computadora ocho voltajes aná¬ 
logos. Se han diseñado esquemas de calibración para llegar a una matriz de calibración 
constante de 6 x 8 que asigna estas ocho mediciones de tensión al vector de fuerza-mo¬ 
mento de torsión T , el cual actúa en el efector final. Como vimos en el ejemplo 5.8, el 
vector de fuerza-momento de torsión detectado puede transformarse en una trama de 
referencia que sea de interés. 

Cuestiones de diseño del sensor de fuerza 

El uso de calibradores de deformación para medir la fuerza se basa en la medición de 
la deflexión de un flexor tensionado. Por lo tanto, una de las principales restricciones 
de diseño está en elegir entre la rigidez y la sensibilidad del sensor. Un sensor más rígi¬ 
do es inherentemente menos sensible. 

La rigidez del sensor también afecta la construcción de la protección contra so¬ 
brecargas. Los indicadores de tensión pueden dañarse mediante una sobrecarga por 
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FIGURA 8.19: La estructura interna de una muñeca detectora de fuerza típica. 

impacto, y por lo tanto deben protegerse contra dichas sobrecargas. El daño al trans¬ 
ductor puede prevenirse mediante topes delimitadores, los cuales evitan que las flexio¬ 
nes se deflexionen más allá de cierto punto. Desafortunadamente, un sensor muy rígido 
podría deflexionarse solamente unas cuantas diezmilésimas de pulgada. Es muy difícil 
fabricar topes delimitadores con esos espacios libres tan pequeños. En consecuencia, 
para muchos transductores debe incorporarse cierto tipo de flexibilidad para poder 
crear posibles topes delimitadores efectivos. 

La eliminación de la histéresis es una de las restricciones más molestas en el dise¬ 
ño de sensores. La mayoría de los metales utilizados como flexores tienen muy poca 
histéresis si no se deforman en exceso. No obstante, las articulaciones sujetas con per¬ 
nos, a presión o soldadas cerca del flexor agregan histéresis. Lo ideal es que el flexor y 
el material cercano a él estén creados a partir de una sola pieza de metal. 

Es importante utilizar medidas diferenciales para incrementar la linealidad y el 
rechazo de disturbios de los sensores de momento de torsión. Las distintas configura¬ 
ciones físicas de los transductores pueden eliminar influencias debidas a los efectos de 
la temperatura y las fuerzas fuera del eje. 

Los indicadores de laminilla de metal son relativamente resistentes, pero produ¬ 
cen un pequeño cambio de resistencia a tensión completa. La eliminación de ruido en 
el cableado del indicador de tensión y en los componentes electrónicos de amplifica¬ 
ción es de crucial importancia para obtener un buen rango dinámico. 

Los indicadores de tensión tipo semiconductor son mucho más susceptibles al da¬ 
ño por sobrecarga, aunque tienen la ventaja de producir un cambio de resistencia de 
aproximadamente setenta veces el de los indicadores de laminilla de metal para una 
tensión dada. Esto hace que la tarea de procesamiento de señales sea mucho más sim¬ 
ple para un rango dinámico dado. 
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EJERCICIOS 

8.1 [15] Se va a utilizar un robot para posicionar un dispositivo de corte con láser. El láser 
produce un rayo de precisión no divergente. Para tareas de corte general, ¿cuántos gra¬ 
dos de libertad necesita el robot de posicionamiento? Justifique su respuesta. 

8.2 [15] Bosqueje una posible configuración de las articulaciones para el robot de posicio¬ 
namiento de láser del ejercicio 8.1, suponiendo que se utilizará principalmente para cor¬ 
tar en ángulos particulares a través de placas de 8 x 8 pies, con 1 pulgada de grosor. 

8.3 [17] Para un robot esférico como el de la figura 8.6, si las articulaciones 1 y 2 no tie¬ 
nen límites y la articulación 3 tiene un límite inferior / y un límite superior u, encuen¬ 
tre el índice de longitud estructural Q L para el punto de la muñeca de este robot. 

8.4 [25] Un eje de acero con una longitud de 30 cm y un diámetro de 0.2 cm controla el 
engranaje de entrada de una reducción con r¡ = 8. El engranaje de salida controla 
un eje de acero que tiene una longitud de 30 cm y un diámetro de 0.3 cm. Si los en¬ 
granajes no introducen deformación por sí solos, ¿cuál es la rigidez total del sistema 
de transmisión? 

8.5 [20] En la figura 8.20 un vínculo se controla a través de un eje que va después de una 
reducción de engranajes. Modele el vínculo como rígido, con una masa de 10 Kg ubi¬ 
cada en un punto a 30 cm del eje del árbol. Suponga que los engranajes son rígidos y 
que la reducción í; es grande. El eje es de acero y debe tener 30 cm de longitud. Si las 
especificaciones de diseño indican que el centro de la masa del vínculo debe soportar 
aceleraciones de 2.0 g, ¿cuál debería ser el diámetro del eje para limitar las deflexio¬ 
nes dinámicas a 0.1 radianes en el ángulo de la articulación? 



FIGURA 8.20: Un vínculo accionado a través de un eje que va después de una reducción 
de engranajes. 
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FIGURA 8.21: Versión simplificada del tren de transmisión de la articulación 4 del 

manipulador PUMA 560 (de [23]). De International Encyclopedia of Robotics, de R. 

Dorf y J. S. Nof, editores. De “Testing” de K. Law, N. Dagalakis y D. Myers. 

8.6 [15] Si el engranaje de salida exhibe una rigidez de 1000 Nt-m/radián con el engrana¬ 
je de entrada bloqueado y el árbol tiene una rigidez de 300 Nt-m/radián, ¿cuál es la ri¬ 
gidez combinada del sistema de transmisión en la figura 8.20? 

8.7 [43] El criterio de Pieper para los manipuladores con vínculos seriales establece que 
el manipulador podrá resolverse si tres ejes consecutivos se intersecan en un solo punto 
o son paralelos. Esto se basa en la idea de que la cinemática inversa puede desacoplarse 
analizando la posición del punto de la muñeca, independientemente de la orientación 
de la trama de la muñeca. Proponga un resultado similar para el mecanismo Stewart de 
la figura 8.f4, para que la solución cinemática directa pueda desacoplarse de manera 
similar. 

8.8 [20] En el mecanismo Stewart de la figura 8.14, si las articulaciones universales 2-DOF 
en la base se sustituyeran por articulaciones cotiloideas 3-DOF, ¿cuál sería el número 
total de grados de libertad del mecanismo? Utilice la fórmula de Grübler. 

8.9 [22] La figura 8.21 muestra un diagrama esquemático simplificado del sistema de 
transmisión de la articulación 4 del PUMA 560 [23]. La rigidez torsional de los aco¬ 
plamientos es de 100 Nt-m/radián en cada uno, la del eje es de 400 Nt-m/radián, y ca¬ 
da uno de los pares de reducción se ha medido para tener una rigidez de salida de 2000 
Nt-m/radián con sus engranajes de entrada fijos. Ambas reducciones tienen ^ = 6. 2 
Suponiendo que la estructura y el cojinete son perfectamente rígidos, ¿cuál es la rigi¬ 
dez en la articulación (en particular, cuando el eje del motor está bloqueado)? 

8.10 [25] ¿Cuál es el error si se aproxima la respuesta al ejercicio 8.9 considerando sólo la 
rigidez del engranaje final de reducción de velocidad? 

8.11 [20] La figura 4.14 muestra una muñeca con eje ortogonal y otra con eje no ortogonal. 
La muñeca con eje ortogonal tiene torsiones de vínculo de una magnitud de 90°; la 
muñeca no ortogonal tiene torsiones de vínculo de </> (en magnitud) y 180°. Describa 
el conjunto de orientaciones que son inalcanzables con el mecanismo no ortogonal. 
Suponga que todos los ejes pueden girar 360° y que, de ser necesario, los vínculos pue¬ 
den pasar unos a través de otros (es decir, el espacio de trabajo no está limitado por 
colisiones automáticas). 


2 Ninguno de los valores numéricos en este ejercicio es real. 
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8.12 [18] Escriba una solución de cinemática inversa general para el mecanismo Stewart 
que se muestra en la figura 8.22. Dada la ubicación de [L] relativa a la trama base ¡fi¡, 
resuelva para las variables de posición de articulación d 1 a d 6 . Los B p ¡ son vectores de 
3x1 que ubican las conexiones base de los actuadores lineales relativos a la trama 
[B\. Los T q ¡ son vectores de 3 x 1 que ubican las conexiones superiores de los actua¬ 
dores lineales respecto a la trama [L]. 

8.13 [20] El determinante jacobiano del manipulador planar de dos vínculos del ejemplo 
5.3 se da mediante 

det (/(©)) =/ 1 / 2 j 2 . (8.31) 

Si la suma de las dos longitudes de vínculo l x + L, se restringe para ser igual a una cons¬ 
tante, ¿cuáles deberían ser las longitudes relativas para poder maximizar la medida de 
manipulabilidad del manipulador, según se definió en la ecuación (8.6)? 

8.14 [28] Para un robot SCARA, dado que la suma de las longitudes de los vínculos 1 y 2 
debe ser constante, ¿cuál es la elección óptima de longitud relativa en términos del ín¬ 
dice de manipulabilidad presentado en la ecuación (8.6)? Podría ser útil resolver pri¬ 
mero el ejercicio 8.13. 

8.15 [35] Demuestre que la medida de manipulabilidad definida en la ecuación (8.6) tam¬ 
bién es igual al producto de los valores propios de /(@). 

8.16 [15] ¿Cuál es la rigidez torsional de un vástago de aluminio de 40 cm con un radio de 
0.1 cm? 

8.17 [5] ¿Cuál es la reducción efectiva de “engranaje” r\ de un sistema de correa que tiene 
una polea de entrada con un radio de 2.0 cm y una polea de salida con un radio de 
12.0 cm? 

8.18 [10] ¿Cuántos grados de libertad se requieren en un manipulador que se utiliza para 
colocar piezas en forma de cilindro en un plano uniforme? Las piezas cilindricas son 
perfectamente simétricas sobre sus ejes principales. 

8.19 [25] La figura 8.23 muestra una mano con tres dedos sujetando un objeto. Cada dedo 
tiene tres articulaciones con un solo grado de libertad. Los puntos de contacto entre 
las puntas de los dedos y el objeto se modelan como “contacto de punto”; esto es, la 
posición es fija pero la orientación relativa es libre en los tres grados de libertad. Por 
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lo tanto, para fines de análisis estos contactos de puntos pueden sustituirse por articu¬ 
laciones cotiloideas 3-DOF. Aplique la fórmula de Grübler para calcular cuántos gra¬ 
dos de libertad posee el sistema en general. 

8.20 [23] La figura 8.24 muestra un objeto conectado a tierra por medio de tres vástagos. Ca¬ 
da vástago está conectado al objeto con una articulación universal 2-DOF y a la tierra 
con una articulación cotiloidea 3-DOF. ¿Cuántos grados de libertad posee el sistema? 



FIGURA 8.23: Una mano con tres dedos, en la que cada dedo tiene tres grados de liber¬ 
tad, atrapa un objeto con “contacto de punto”. 



8.21 [18] Verifique que si dos sistemas de transmisión están conectados en forma serial, la 
rigidez total del sistema se debe obtener mediante la ecuación (8.14). Es tal vez más 
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simple pensar en la conexión serial de dos resortes lineales que tienen coeficientes de 
rigidez k x y k 2 y en las ecuaciones resultantes: 

/ = k-L&Xy, 

f = k 2 Sx 2 , (8.32) 

/ = k mm( Sx l + á *2)- 

8.21 [20] Derive una fórmula para la rigidez de un sistema de control de correa en térmi¬ 
nos de los radios de la polea (r, y r 2 ) y de la distancia de centro a centro entre las po¬ 
leas, d c . Empiece desde la ecuación (8.22). 


EJERCICIO DE PROGRAMACIÓN (PARTE 8) 


1. Escriba un programa para calcular la determinante de una matriz de 3 x 3. 

2. Escriba un programa para mover el robot simulado de tres vínculos en 20 pasos en lí¬ 
nea recta y una orientación constante, de 


a 



0.25 

0.0 

0.0 



0.95 

0.0 

0.0 


en incrementos de 0.05 metros. En cada ubicación, calcule la medida de manipulabi- 
lidad para el robot en esa configuración (es decir, el determinante del jacobiano). Lis¬ 
te o, mejor aún, haga un trazo de los valores como una función de la posición a lo largo 
del eje Jt Q . Genere los datos anteriores para dos casos: 


(a) l ¡ = l 2 — 0.5 metros. 

(b) l 2 = 0.625 metros, l 2 = 0.375 metros. 


¿Cuál diseño de manipulador piensa usted que es mejor? Explique su respuesta. 


EJERCICIO MATLAB 8 

En la sección 8.5 presentamos el concepto de robots cinemáticamente redundantes. En es¬ 
te ejercicio trataremos la simulación de control con velocidad resuelta para un robot cine¬ 
máticamente redundante. Nos enfocaremos en el robot planar 4-DOF 4R con un grado de 
redundancia cinemática (cuatro articulaciones para proporcionar tres movimientos carte¬ 
sianos: dos traslaciones y una rotación). Este robot se obtiene agregando una cuarta articu¬ 
lación R y un cuarto vínculo móvil L 4 al robot planar 3-DOF 3R (de las figuras 3.6 y 3.7; los 
parámetros de DFI pueden extenderse si agregamos una fila a la figura 3.8). 

Para el robot planar 4R derive expresiones analíticas para la matriz jacobiana de 3 x 4; 
después realice una simulación de control con velocidad resuelta en MATLAB (como en el 
ejercicio MATLAB 5). La forma de la ecuación de velocidad es, de nuevo, k X = k J&; no 
obstante, esta ecuación no puede invertirse mediante la inversa de matriz normal, ya que la 
matriz jacobiana no es cuadrada (tres ecuaciones, cuatro variables desconocidas, soluciones 
infinitas para 0). Por lo tanto, vamos a utilizar la seudo inversa Moore-Penrose J* de la ma¬ 
triz jacobiana: J* = J T (JJ T )~K Para las velocidades de articulación relativas comandadas que 
resultan para el algoritmo de proporción resuelta, 8 = k J* k X, seleccione la solución de 
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norma mínima entre las posibilidades infinitas (es decir, esta 0 específica es lo más peque¬ 
ña posible para satisfacer las velocidades cartesianas k X comandadas). 

Esta solución representa solamente la solución particular; es decir, existe una solución 
homogénea para optimizar el rendimiento (como evitar las singularidades del manipulador 
o evitar los límites de las articulaciones), además de satisfacer el movimiento cartesiano co¬ 
mandado. (La optimización del rendimiento está más allá del alcance de este libro). 

Dadas: L 1 = 1.0 m, L 2 = 1.0 m, L 3 = 0.2 m, L 4 = 0.2 m. 

Los ángulos iniciales son: 


0 = 


Í%1 


1 

u> 

o 

I 0 

0 2 


70 

«3 


30° 

k 


0 

O 

'Ñl- 


La velocidad cartesiana comandada (constante) es 



X 1 

0 

[- 0.21 

°x = °\ 

y 

KJ 

I = 1 

- 0.2 i 
0.2 j 


(m/s, rad/s). 


Simule el movimiento con velocidad resuelta para la solución particular solamente, duran¬ 
te 3 segundos, con un intervalo de control de 0.1 segundos. Además, en el mismo ciclo ani¬ 
me el robot en la pantalla durante cada intervalo, para que pueda observar el movimiento 
simulado y verificar que sea correcto. 

a) Presente cuatro diagramas (cada conjunto en un gráfico separado, por favor): 

1. Los cuatro ángulos de articulación (grados) © = {6 1 0 2 9 3 9 A } r contra el tiempo. 

2. Las cuatro proporciones de articulación (rad/s) 0 = { 9 3 0 2 9 3 9 4 } T contra el tiempo. 

3. La norma euclidiana de proporción de articulación ||0|| (magnitud vectorial) 
contra el tiempo. 

4. Los tres componentes cartesianos de j^7j X = {x y <p} T (radianes está bien para 
4>, de manera que se ajuste) contra el tiempo. 

Etiquete cuidadosamente (a mano está bien) cada componente en cada diagrama. 
Además, etiquete los nombres de los ejes y las unidades. 

b) Verifique los resultados de su matriz jacobiana para los conjuntos de ángulos inicial y 
final mediante la Herramienta de Robótica MATLAB de Corke. Pruebe la función 
jacob0(). Precaución: Las funciones jacobianas del cuadro de herramientas son para 
el movimiento de {4}respecto a ¡0), no para [H] respecto a {0} como en la asignación 
del problema. La función anterior proporciona el resultado jacobiano en coordenadas 
de {0}; jacobn() daría los resultados en coordenadas de la trama {4} 
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9.1 INTRODUCCIÓN 

9.2 RETROALIMENTACIÓN Y CONTROL DE LAZO CERRADO 

9.3 SISTEMAS LINEALES DE SEGUNDO ORDEN 

9.4 CONTROL DE SISTEMAS DE SEGUNDO ORDEN 

9.5 PARTICIONAMIENTO DE LEYES DE CONTROL 

9.6 CONTROL DE SEGUIMIENTO DE TRAYECTORIAS 

9.7 RECHAZO DE PERTURBACIONES 

9.8 COMPARACIÓN ENTRE CONTROL DE TIEMPO CONTINUO Y DISCRETO 

9.9 MODELADO Y CONTROL DE UNA SOLA ARTICULACIÓN 

9.10 ARQUITECTURA DE UN CONTROLADOR DE ROBOT INDUSTRIAL 


9.1 INTRODUCCIÓN 

Armados con el material anterior, ahora tenemos los medios para calcular historiales 
de tiempo de la posición de las articulaciones que correspondan a los movimientos 
deseados del efector final a través del espacio. En este capítulo empezaremos por ha¬ 
blar sobre cómo hacer que el manipulador verdaderamente realice estos movimien¬ 
tos deseados. 

Los métodos de control que describiremos caen en la clase llamada sistemas de 
control lineal. En sentido estricto, el uso de técnicas de control lineal es válido solamen¬ 
te cuando el sistema que se está estudiando puede modelarse matemáticamente me¬ 
diante ecuaciones diferenciales lineales. Para el caso del control de manipuladores, 
dichos métodos lineales deben verse como métodos aproximados ya que, como vimos 
en el capítulo 6, la dinámica de un manipulador se representa más adecuadamente me¬ 
diante una ecuación diferencial no lineal. Sin embargo, veremos que a menudo es razo¬ 
nable hacer dichas aproximaciones, y también es el caso de que estos métodos lineales 
son los que se utilizan con más frecuencia en la práctica industrial actual. 

Por último, la consideración del método lineal servirá como base para el trata¬ 
miento más complejo de los sistemas de control no lineales que veremos en el capítulo 
10. Aunque nos acercamos al control lineal como un método aproximado para el con¬ 
trol de manipuladores, la justificación de usar controladores lineales no solamente es 
empírica. En el capítulo 10 demostraremos que cierto controlador lineal produce un 
sistema de control razonable, incluso sin requerir una aproximación lineal de la diná¬ 
mica del manipulador. Tal vez los lectores familiarizados con sistemas de control lineal 
quieran saltarse las primeras cuatro secciones del presente capítulo. 
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9.2 RETROALIMENTACIÓN Y CONTROL DE LAZO CERRADO 

Vamos a modelar un manipulador como un mecanismo equipado con sensores en cada 
articulación para medir el ángulo de articulación, y que tiene un actuador en cada articu¬ 
lación para aplicar un momento de torsión sobre el vínculo adyacente (de mayor orden). 1 
Aunque algunas veces se utilizan otros arreglos físicos de sensores, la gran mayoría de los 
robots tienen un sensor de posición en cada articulación. Algunas veces también se utili¬ 
zan sensores de velocidad (tacómetros) en las articulaciones. Hay varios esquemas de ac¬ 
tuación y transmisión que prevalecen en los robots industriales, pero muchos de ellos 
pueden modelarse suponiendo que hay un solo actuador en cada articulación. 

Deseamos hacer que las articulaciones del manipulador sigan trayectorias de po¬ 
sición prescritas, pero los actuadores son comandados en términos de momento de tor¬ 
sión, por lo que debemos utilizar algún tipo de sistema de control para calcular los 
comandos apropiados del actuador que realicen este movimiento deseado. Casi siem¬ 
pre estos momentos de torsión están determinados por el uso de retroalimentación de 
los sensores de las articulaciones para calcular el momento de torsión requerido. 

La figura 9.1 muestra la relación entre el generador de trayectorias y el robot fí¬ 
sico. El robot acepta un vector de momentos de torsión r del sistema de control. Los 
sensores del manipulador permiten al controlador leer los vectores de las posiciones de 
las articulaciones, 0, y las velocidades de las articulaciones, ©. Todas las líneas de se¬ 
ñal en la figura 9.1 llevan vectores de N x 1 (en donde N es el número de articulacio¬ 
nes en el manipulador). 

Consideremos qué algoritmo podría implementarse en el bloque etiquetado co¬ 
mo “sistema de control” en la figura 9.1. Una posibilidad sería usar la ecuación dinámi¬ 
ca del robot (según lo estudiado en el capítulo 6) para calcular los momentos de torsión 
requeridos para una trayectoria específica. El generador de trayectorias nos proporcio¬ 
na 0 rf , @ (/ y © d , por lo que podríamos usar la ecuación (6.59) para calcular 

r = M(@ d )@ d + V(® d ,@ d ) + G(® d ). (9.1) 

Esto nos da los momentos de torsión que nuestro modelo indica que serían requeridos 
para realizar la trayectoria deseada. Si nuestro modelo dinámico fuera completo y pre¬ 
ciso y no hubiera “ruido” u otras perturbaciones, el uso continuo de la ecuación (9.1) 
sobre la trayectoria deseada realizaría la trayectoria deseada. Desafortunadamente, la 
imperfección en el modelo dinámico y la inevitable presencia de disturbios hacen que 
un esquema así sea poco práctico para utilizarse en aplicaciones reales. A una técnica 
de control así se le denomina esquema de lazo abierto, ya que no se utiliza la retroali¬ 
mentación de los sensores de las articulaciones [es decir, la ecuación (9.1) es una función 



FIGURA 9.1: Diagrama de bloques de alto nivel de un sistema de control de robot. 


1 Recuerde que todos los comentarios que se hagan respecto a las articulaciones giratorias son análogos 
para las articulaciones lineales, y viceversa. 
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sólo de la trayectoria deseada, representada por ® d , y de sus derivadas, y no es una fun¬ 
ción de ©, la trayectoria actual]. 

Generalmente, la única forma de construir un sistema de control de alto rendi¬ 
miento es utilizando la retroalimentación de los sensores de las articulaciones, como se 
indica en la figura 9.1. Esta retroalimentación se utiliza comúnmente para calcular cual¬ 
quier error de servo, encontrando la diferencia entre la posición deseada y la posición 
actual, y la diferencia entre la velocidad deseada y la velocidad actual: 

E = ® d ~®, 

É = @ d -@. (9.2) 

Así, el sistema de control puede calcular cuánto momento de torsión se requiere de los 
actuadores como alguna función del error de servo. Obviamente, la idea básica es calcu¬ 
lar momentos de torsión de los actuadores que tiendan a reducir los errores de servo. A 
un sistema de control que utiliza retroalimentación se le llama sistema de lazo cerrado. 
En la figura 9.1 se aprecia el “lazo” cerrado alrededor del manipulador por un sistema de 
control de ese tipo. 

El problema central al diseñar un sistema de control es asegurar que el sistema de 
lazo cerrado resultante cumpla con ciertas especificaciones de rendimiento. El criterio más 
básico de este tipo es que el sistema permanezca estable. Para nuestros fines, definiremos 
a un sistema como estable si los errores permanecen “pequeños” al ejecutar varias trayec¬ 
torias deseadas, incluso en la presencia de ciertas perturbaciones “moderadas”. Hay que 
tener en cuenta que un sistema de control diseñado inapropiadamente puede algunas ve¬ 
ces producir una operación inestable, en donde los errores de servo se agrandan en vez de 
reducirse. Por ende, la primera tarea de un ingeniero de control es demostrar que su dise¬ 
ño produce un sistema estable; la segunda tarea es demostrar que el rendimiento de lazo 
cerrado del sistema es satisfactorio. En la práctica, dichas “pruebas” varían desde las prue¬ 
bas matemáticas basadas en ciertas suposiciones y modelos hasta los resultados más em¬ 
píricos, tales como los que se obtienen a través de la simulación o la experimentación. 

La figura 9.1, en la que todas las líneas de señal representan vectores de N x 1, 
resume el hecho de que el problema de control de los manipuladores es un problema 
de control multientradas, multisalidas (MIMO). En este capítulo usaremos un método 
simple para construir un sistema de control, tratando cada articulación como un sistema 
que debe controlarse por separado. En consecuencia, para un manipulador con N articu¬ 
laciones diseñaremos N sistemas independientes de control de una entrada, una salida 
(SISO). Este es el método de diseño adoptado actualmente por la mayoría de los pro¬ 
veedores de robots industriales. Este método de control independiente de las articula¬ 
ciones es un método aproximado, ya que las ecuaciones de movimiento (desarrolladas 
en el capítulo 6) no son independientes, sino que tienen muchos acoplamientos. Más 
adelante presentaremos una justificación para el método lineal, cuando menos para el 
caso de los manipuladores con muchos engranajes. 

9.3 SISTEMAS LINEALES DE SEGUNDO ORDEN 

Antes de considerar el problema de control de los manipuladores, retrocedamos y em¬ 
pecemos por considerar un sistema mecánico simple. La figura 9.2 muestra un bloque 
de masa m unido a un resorte con una rigidez k y sujeto a una fricción de coeficiente b. 
La figura 9.2 también indica la posición cero y el sentido positivo de x, la posición del 
bloque. Suponiendo una fuerza de fricción proporcional a la velocidad del bloque, un 
diagrama de cuerpo libre de las fuerzas que actúan sobre el bloque nos conduce direc¬ 
tamente a la ecuación de movimiento, 
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FIGURA 9.2: Sistema de resorte-masa con fricción. 


mx + bx + kx = 0. 


(9.3) 


Por consecuencia, la dinámica de lazo abierto de este sistema con un grado de libertad 
se describe mediante una ecuación diferencial lineal, de coeficientes constantes y se¬ 
gundo orden [1]. La solución a la ecuación diferencial (9.3) es una función del tiempo, 
x(t), que especifica el movimiento del bloque. Esta solución dependerá de las condicio¬ 
nes iniciales del bloque, es decir, de su posición y su velocidad iniciales. 

Utilizaremos este simple sistema mecánico como un ejemplo con el cual podremos 
repasar ciertos conceptos básicos de un sistema de control. Desafortunadamente, es im¬ 
posible hacer justicia al campo de la teoría de control con sólo una breve introducción. 
Hablaremos sobre el problema de control, asumiendo que el estudiante está familiariza¬ 
do con las ecuaciones diferenciales simples. Por ende, no utilizaremos muchas de las po¬ 
pulares herramientas del área de ingeniería de control. Por ejemplo, las transformadas de 
Laplace y otras técnicas comunes no son un prerrequisito ni se presentan aquí. Una bue¬ 
na referencia para este campo es [4]. 

La intuición sugiere que el sistema de la figura 9.2 podría exhibir varios movimien¬ 
tos característicos distintos. Por ejemplo, en el caso de un resorte muy débil (es decir, con 
un valor de k pequeño) y una fricción muy pesada (es decir, un valor de b grande) cual¬ 
quiera podría imaginarse que si el bloque fuera perturbado regresaría a su posición de 
descanso muy lentamente. Sin embargo, con un resorte muy rígido y una fricción muy ba¬ 
ja, el bloque podría oscilar varias veces antes de quedar en reposo. Estas distintas posibi¬ 
lidades surgen debido a que el carácter de la solución a la ecuación (9.3) depende de los 
valores de los parámetros m, b y k. 

Del estudio de las ecuaciones diferenciales [1] sabemos que la forma de la solución 
a una ecuación de la forma de la ecuación (9.3) depende de las raíces de su ecua¬ 
ción característica, 

ms 2 + bs + k — 0. (9.4) 

Esta ecuación tiene las raíces 


b \¡ b 2 — 4 mk 

2 m 2 m 

b \] b 2 — 4 mk 

2 m 2 m 


(9.5) 


La ubicación de Sj y s 2 (algunas veces llamados los polos del sistema) en el plano real- 
imaginario dicta la naturaleza de los movimientos del sistema. Si jj y s 2 son reales, en¬ 
tonces el comportamiento del sistema es lento y no oscilatorio. Si Sj y s 1 son complejos 
(es decir, si tienen un componente imaginario) entonces el comportamiento del sistema 
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es oscilatorio. Si incluimos el caso limitante especial entre estos dos comportamientos, 
tenemos tres clases de respuesta por estudiar: 

1. Raíces reales y desiguales. Éste es el caso cuando b 2 > 4 mk\ esto es, la fricción 
domina y se produce un comportamiento lento. A esta respuesta se le llama so¬ 
breamortiguada. 

2. Raíces complejas. Éste es el caso cuando b 2 < 4 mk: esto es, la rigidez domina y 
se produce un comportamiento oscilatorio. A esta respuesta se le llama subamor¬ 
tiguada. 

3. Raíces reales e iguales. Éste es el caso especial cuando b 2 — 4 mk\ esto es, la fric¬ 
ción y la rigidez están “balanceadas”, lo que produce la respuesta no oscilatoria 
más rápida posible. A esta respuesta se le llama críticamente amortiguada. 

El tercer caso (amortiguamiento crítico) es generalmente una situación deseable: 
el sistema anula las condiciones iniciales distintas de cero y regresa a su posición nomi¬ 
nal lo más rápido posible, pero sin comportamiento oscilatorio. 

Raíces reales y desiguales 

Puede demostrarse fácilmente [por sustitución directa en la ecuación (9.3)] que la so¬ 
lución x(t), que proporciona el movimiento del bloque en el caso de raíces reales y de¬ 
siguales, tiene la forma 

x(t) = c 1 e Slt + c 2 e S2 ‘, (9.6) 

en donde Sj y s 2 se dan mediante la ecuación (9.5). Los coeficientes c 1 y c 2 son constan¬ 
tes que pueden calcularse para cualquier conjunto dado de condiciones iniciales (es de¬ 
cir, la posición y la velocidad iniciales del bloque). 

La figura 9.3 muestra un ejemplo de las ubicaciones de los polos y la correspon¬ 
diente respuesta en el tiempo para una condición inicial distinta de cero. Cuando los 
polos de un sistema de segundo orden son reales y desiguales, el sistema exhibe un mo¬ 
vimiento lento o sobreamortiguado. 

En los casos en que uno de los polos tiene una magnitud mucho mayor que la otra, 
el polo de mayor magnitud puede ignorarse, ya que el término que corresponde a éste 
disminuirá a cero rápidamente, en comparación con el otro polo dominante. Esta mis¬ 
ma noción de la dominación se extiende a los sistemas de mayor orden; por ejemplo, a 




FIGURA 9.3: Ubicación de la raíz y la respuesta a las condiciones iniciales para un sis¬ 
tema sobreamortiguado. 
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menudo un sistema de tercer orden puede estudiarse como sistema de segundo orden 
si se consideran solamente los dos polos dominantes. 


EJEMPLO 9.1 

Determine el movimiento del sistema de la figura 9.2 si los valores de los parámetros 
son m = 1, b = 5 y k = 6, y si el bloque (inicialmente en reposo) se libera desde la po¬ 
sición x — — 1. 

La ecuación característica es 

s 2 + 5s + 6 = 0, (9-7) 

la cual tiene las raíces s 1 = —2y s 2 = —3. Por consecuencia, la respuesta tiene la forma 

x(t) = c 1 e~ 2t + c 2 e~ 3 '. (9-8) 

Ahora vamos a utilizar las condiciones iniciales dadas, x(0) = — 1 y x(0) = 0, para calcu¬ 
lar c 1 y c 2 - Para satisfacer estas condiciones cuando t — 0, debemos tener 

c i + c 2 = - 1 


y 


—2c 1 - 3c 2 = 0, (9.9) 

las cuales se satisfacen cuando c 1 — — 3 y c 2 = 2. Así, el movimiento del sistema para 
t > 0 se da mediante 


x(t) = —3e 2í + 2e 3r . 


(9.10) 


Raíces complejas 

Para el caso en el que la ecuación característica tiene raíces complejas de la forma 

íj = A. + /xi, 

s 2 = A — (9.11) 

la solución sigue teniendo la forma 

x(t) = c 1 e Sl> + c 2 e S2 '. (9.12) 

No obstante, la ecuación (9.12) es difícil de usar directamente, ya que involucra explí¬ 
citamente a los números imaginarios. Puede demostrarse (vea el ejercicio 9.1) que la 

fórmula de Euler, 

e ,x = cosx + i sen x, (9-13) 

permite que la solución (9.12) se manipule para expresarse en la forma 

x(t ) = c 1 e Xt eos (¡it) + c 2 e Xt sen(jxt). (9-14) 

Como antes, los coeficientes c x y c 7 son constantes que pueden calcularse para cual¬ 
quier conjunto dado de condiciones iniciales (es decir, la posición y la velocidad iniciales 
del bloque). Si escribimos las constantes c 1 y c 2 en la forma 

Cj = reos 8, 

c 2 — r sená, 


(9.15) 




268 Capítulo 9 Control lineal de los manipuladores 

entonces la ecuación (9.14) puede escribirse en la forma 

x(t) — re kl cos(qr — S), (9.16) 

en donde 

r = y c 2 + 4 

á = Atan2(c 2 , Cj). (9-17) 

En esta forma es más sencillo ver que el movimiento resultante es una oscilación cuya 
amplitud está disminuyendo exponencialmente hacia cero. 

Otra forma común de describir los sistemas oscilatorios de segundo orden es en 
términos de la constante de amortiguamiento y la frecuencia natural. Estos términos se 
definen por la parametrización de la ecuación característica, dada por 

s 2 + 2¡;co n s + co 2 = 0, (9-18) 

en donde f es la constante de amortiguamiento (un número sin dimensión, entre 0 y 1) 
y a> n es la frecuencia natural. 2 Las relaciones entre las ubicaciones de los polos y estos 
parámetros son 

k 

y 

M = - C 2 . (9.19) 

En esta terminología, ¡i, la parte imaginaria de los polos, se conoce algunas veces como 
la frecuencia natural amortiguada. Para un sistema de resorte-masa amortiguado tal 
como el de la figura 9.2, la proporción de amortiguamiento y la frecuencia natural son, 
respectivamente, 


b 



co n = yj k/m. (9.20) 

Cuando no hay amortiguamiento presente (b = 0 en nuestro ejemplo), la constante de amor¬ 
tiguamiento se vuelve cero; para un amortiguamiento crítico (b 2 — 4km). la constante es 1. 

La figura 9.4 muestra un ejemplo de las ubicaciones de los polos y la correspon¬ 
diente respuesta en el tiempo para una condición inicial distinta de cero. Cuando los 
polos de un sistema de segundo orden son complejos, el sistema exhibe un movimien¬ 
to oscilatorio o subamortiguado. 


EJEMPLO 9.2 

Encuentre el movimiento del sistema en la figura 9.2 si los valores de los parámetros 
son m = 1, b — 1 y k = 1, y si el bloque (inicialmente en reposo) se libera desde la po¬ 
sición x = —1. 

La ecuación característica es 


í 2 + í + 1 = 0, (9-21) 

2 Los términos “constante de amortiguamiento” y “frecuencia natural” también pueden aplicarse a sis¬ 
temas con alto amortiguamiento, en cuyo caso f >1.0. 
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FIGURA 9.4: Ubicación de la raíz y respuesta a las condiciones iniciales para un sistema 
subamortiguado. 


i /% 

la cual tiene las raíces s¡ = — 2 ± ^f-i. Por lo tanto, la respuesta tiene la forma 


V3 


V3 


x(t) = e 2 I Cl eos — t + c 2 sen — í 


(9.22) 


Ahora utilizamos las condiciones iniciales dadas, x(0) = — 1 y i(0) = 0, para calcu¬ 
lar c 1 y c 2 . Para satisfacer estas condiciones cuando t — 0, debemos tener 


Ct = -1 


y 

-^c 1 --^ c 2 = 0 ’ (9.23) 

las cuales se satisfacen cuando c, = -lyc 2 = Por lo tanto, el movimiento del sis¬ 
tema para t > 0 se da mediante 

, / 

x(t) — e 2 I — eos 

Este resultado también puede ponerse en la forma de la ecuación (9.16): 


V3 V3 V3 i 

—t -sen — t 

2 3 2 ¡ 


(9.24) 


2V3 _ r 

x(t) = ~——e 2 eos 



(9.25) 


Raíces reales e iguales 

Por sustitución, en la ecuación (9.3) puede demostrarse que, en el caso de raíces reales 
e iguales (es decir, raíces repetidas), la solución tiene la forma 

x(t) = c^e Slt + c 2 te S2Í , 


(9.26) 
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FIGURA 9.5: Ubicación de la raíz y respuesta a las condiciones iniciales para un sistema 
críticamente amortiguado. 


en donde, en este caso, ^t — s 2 = ~ por lo que la ecuación (9.29) puede escribirse así: 

x(t) = (c 1 + c 2 t)e~^'. (9.27) 

En caso de que no quede claro, una rápida aplicación de la regla de l’Hopital [2] 
muestra que, para cualquier valor de c p c 2 y a, 

bjn (q + c 2 t)e~ at = 0 . ( 9 . 28 ) 

La figura 9.5 muestra un ejemplo de las ubicaciones de los polos y la correspon¬ 
diente respuesta en el tiempo para una condición inicial distinta de cero. Cuando los 
polos de un sistema de segundo orden son reales e iguales, el sistema exhibe un movi¬ 
miento críticamente amortiguado, la respuesta no oscilatoria más rápida posible. 


EJEMPLO 9.3 

Encuentre el movimiento del sistema de la figura 9.2 si los valores de los parámetros 
son m = l,b = 4yk = 4, y si el bloque (inicialmente en reposo) se libera desde la po¬ 
sición x = —1. 

La ecuación característica es 

s 2 + 4s + 4 = 0, (9.29) 

la cual tiene las raíces .sq = s 2 = —2. Por lo tanto, la respuesta tiene la forma 

x(t) = (cq + c 2 t)e~ 2 '. (9.30) 

Ahora vamos a utilizar las condiciones iniciales dadas, jc( 0) = — 1 y i(0) = 0, pa¬ 
ra calcular c 1 y c 2 . Para satisfacer estas condiciones cuando t — 0, debemos tener 

c i = -l 


las cuales se satisfacen cuando c 1 = — 1 y c 2 
tema para t > 0 se da mediante 


= 0, (9.31) 

: —2. Por lo tanto, el movimiento del sis- 


x(t) = (—1 — 2f)e 21 . 


(9.32) 
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En los ejemplos del 9.1 a 9.3, todos los sistemas eran estables. Para cualquier sis¬ 
tema físico pasivo como el de la figura 9.2, éste será el caso. Dichos sistemas mecánicos 
siempre tienen las propiedades 

m > 0, 

* > 0, (9.33) 

k > 0. 

En la siguiente sección veremos que la acción de un sistema de control es, en efecto, 
cambiar el valor de uno o más de estos coeficientes; será necesario considerar si el sis¬ 
tema resultante es estable o no. 

9.4 CONTROL DE SISTEMAS DE SEGUNDO ORDEN 

Suponga que la respuesta natural de nuestro sistema mecánico de segundo orden no es 
lo que deseamos. Tal vez tenga bajo amortiguamiento y sea oscilatorio, y nos gustaría 
que fuera críticamente amortiguado; o tal vez no tenga un resorte (k = 0) por lo que el 
sistema nunca regresa a x = 0 si se le perturba. Mediante el uso de sensores, un actua- 
dor y un sistema de control podemos modificar el comportamiento del sistema según lo 
deseemos. 

La figura 9.6 muestra un sistema de resorte-masa amortiguado al que se agregó 
un actuador, con el cual es posible aplicar una fuerza/al bloque. Un diagrama de cuer¬ 
po libre nos conduce a la ecuación de movimiento, 

mx + bx + kx — f. (9-34) 

Vamos a suponer también que tenemos sensores capaces de detectar la posición y la ve¬ 
locidad del bloque. Ahora propondremos una ley de control, la cual calcula la fuerza 
que el actuador debe aplicar como una función de la retroalimentación detectada: 

/ = -k p x - k v x. (9.35) 

La figura 9.7 es un diagrama de bloques del sistema de lazo cerrado, en donde la por¬ 
ción a la izquierda de la línea punteada es el sistema de control (que generalmente se 
implementa en una computadora) y a la derecha de la línea punteada se encuentra el 
sistema físico. En la figura están implícitas las interfaces entre la computadora de con¬ 
trol y los comandos del actuador de salida, y la información del sensor de entrada. 

El sistema de control que hemos propuesto es un sistema regulador de posición; 
simplemente trata de mantener la posición del bloque en un lugar fijo, sin importar qué 



FIGURA 9.6: Un sistema de resorte-masa amortiguado, con un actuador. 
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FIGURA 9.7: Un sistema de control de lazo cerrado. La computadora de control (a la iz¬ 
quierda de la línea punteada) lee la entrada del sensor y escribe los comandos de sali¬ 
da del actuador. 

fuerzas perturbadoras se apliquen al bloque. En una sección posterior construiremos 
un sistema de control de seguimiento de trayectorias, el cual puede hacer que el bloque 
siga una trayectoria de posiciones deseadas. 

Al igualar la dinámica de lazo abierto de la ecuación (9.34) con la ley de control 
de la ecuación (9.35), podemos derivar la dinámica de lazo cerrado así: 

mx + bx + kx = —k p x — k v x, (9.36) 

o 

mx + (b + k v )x + (k + k p )x = 0, (9.37) 

o 

mix + b' x + k!x — 0, (9.38) 

en donde b' = b + k v y k' — k + k . De las ecuaciones (9.37) y (9.38) queda claro que, 
al establecer las ganancias de control k v y k p podemos hacer que el sistema de lazo 
cerrado parezca tener el comportamiento de cualquier sistema de segundo orden que 
deseemos. A menudo se selec cionan las ganancias para obtener un amortiguamiento 
crítico (es decir, b' = 2\/ mk') y cierta rigidez de lazo cerrado proporcionada directa¬ 
mente por k'. 

Observe que k y y k p podrían ser positivas o negativas, dependiendo de los pará¬ 
metros del sistema original. No obstante, si b' o k' se vuelven negativas, el resultado se¬ 
ría un sistema de control inestable. Esta inestabilidad será obvia si se escribe la solución 
de la ecuación diferencial de segundo orden [en la forma de las ecuaciones (9.6), (9.14) 
o (9.26)]. También tiene sentido intuitivo que, si b' o k' son negativas, los errores de 
servo tiendan a magnificarse en vez de reducirse. 


EJEMPLO 9.4 

Si los parámetros del sistema de la figura 9.6 son m = 1, b = 1 y k = 1, encuentre las 
ganancias k y k y para una ley de control de regulación de la posición que haga que el 
sistema esté críticamente amortiguado con una rigidez de lazo cerrado de 16.0. 
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Si deseamos que k' sea 16.0, entonces para un amortiguamiento crítico necesita¬ 
mos que b' — 2\Jmk' = 8.0. Ahora, k = 1 y b — 1, por lo que necesitamos que 


k p = 15.0, 

k v = 7.0. (9.39) 


9.5 PARTICIONAMIENTO DE LEYES DE CONTROL 

Para diseñar leyes de control para sistemas más complicados, vamos a considerar una 
estructura de controlador ligeramente distinta para el problema de ejemplo de la figu¬ 
ra 9.6. En este método particionaremos el controlador en una porción basada en el 
modelo y en una porción de servo. Como resultado los parámetros del sistema (es de¬ 
cir, m, b y k en este caso) aparecen solamente en la porción basada en el modelo, y la 
porción de servo es independiente de estos parámetros. Hasta ahora esta distinción po¬ 
dría no parecer relevante, pero su importancia se hará obvia a medida que consideremos 
los sistemas no lineales en el capítulo 10. Adoptaremos este método de particionamien¬ 
to de las leyes de control en todo el libro. 

La ecuación de lazo abierto del movimiento para el sistema es 

mx + bx + kx — f. (9.40) 

Deseamos descomponer el controlador para este sistema en dos partes. En este caso, 
la porción de la ley de control basada en el modelo utilizará el supuesto conocimiento 
de m, b y k. Esta porción de la ley de control se establece de manera tal que reduzca el 
sistema para que parezca una masa unitaria. Esto nos quedará más claro cuando haga¬ 
mos el ejemplo 9.5. La segunda parte de la ley de control hace uso de la retroalimenta- 
ción para modificar el comportamiento del sistema. La porción de la ley de control 
basada en el modelo tiene el efecto de hacer que el sistema aparezca como una masa 
unitaria, por lo que el diseño de la porción de servo es muy simple: se seleccionan las 
ganancias para controlar un sistema compuesto de una sola masa unitaria (es decir, sin 
fricción y sin rigidez). 

La porción del control basada en el modelo aparece en una ley de control de la 
forma 

/ = «/' + P, (9.41) 

en donde ay fi son funciones o constantes y se seleccionan de manera que si/' se toma 
como la nueva entrada al sistema, que parece ser una masa unitaria. Con esta estructu¬ 
ra de la ley de control, la ecuación del sistema (el resultado de combinar las ecuaciones 
(9.40) y (9.41)) es 

mx + bx + kx = af' + /. (9.42) 

Evidentemente, para que el sistema aparezca como una masa unitaria desde la entrada 
/', para este sistema específico debemos seleccionar a y / de la siguiente manera: 

a = m, 

P = bx + kx. (9.43) 

Al hacer estas asignaciones y sustituir en la ecuación (9.42), tenemos el sistema 

x = (9.44) 
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FIGURA 9.8: Un sistema de control de lazo cerrado que emplea el método de control 
particionado. 


Ésta es la ecuación de movimiento para una masa unitaria. Ahora procederemos como 
si la ecuación (9.44) fuera la dinámica de lazo abierto de un sistema a controlar. Dise¬ 
ñamos una ley de control para calcular/', igual que antes: 

f = ~K* ~ k P x - ( 9 - 45 ) 

Al combinar esta ley de control con la ecuación (9.44) se produce 

x + k v x + k p x = 0. (9.46) 

Bajo esta metodología es fácil establecer las ganancias de control, además de que es al¬ 
go independiente de los parámetros del sistema; esto es, 


k 


V 



(9.47) 


debe ser válida para el amortiguamiento crítico. La figura 9.8 muestra un diagrama de 
bloques del controlador particionado que se usó para controlar el sistema de la figura 9.6. 


EJEMPLO 9.5 

Si los parámetros del sistema de la figura 9.6 son m — 1, b = 1 y k — 1, encuentre a, / 
y las ganancias k y k v para una ley de control de regulación de posición que haga que 
el sistema esté críticamente amortiguado, con una rigidez de lazo cerrado de 16.0. 
Elegimos 


a — 1 , 

P = x + x, (9.48) 


tal que el sistema aparezca como una masa unitaria para la entrada ficticia/'. Luego asig¬ 
namos a la ganancia k p la rigidez de lazo cerrado deseada y hacemos que k v — 2\k pa¬ 
ra un amortiguamiento crítico. 
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Esto nos da 


k p = 16.0, 
K = 8 . 0 . 


(9.49) 


9.6 CONTROL DE SEGUIMIENTO DE TRAYECTORIAS 

Vamos a mejorar nuestro controlador de manera que pueda hacer que el bloque siga 
una trayectoria en lugar de mantenerlo en una sola ubicación. Esta trayectoria está dada 
por una función del tiempo, x d (t), la cual especifica la posición deseada del bloque. Su¬ 
ponemos que la trayectoria es uniforme (es decir, que las primeras dos derivadas exis¬ 
ten) y que nuestro generador de trayectorias proporciona x d , x d y x d en todos los 
tiempos t. Definiremos el error de servo entre las trayectorias deseada y real como e — 
x d — x. Una ley de servocontrol que producirá el seguimiento de la trayectoria es 

/' = x d + k v ¿ + k p e. (9-50) 

Podemos ver que la ecuación (9.50) es una buena opción si la combinamos con la de 
movimiento de una masa unitaria (9.44), la cual nos lleva a 

* = ü + M + V’ ( 9 - 51 ) 

o a 

e + k v é + k p e — 0. (9-52) 

Esta es una ecuación diferencial de segundo orden para la cual podemos elegir los coe¬ 
ficientes, de manera que podemos diseñar cualquier respuesta. (A menudo, la elección 
es amortiguamiento crítico). Algunas veces se dice que dicha ecuación está escrita en 
espacio de error, ya que describe la evolución de los errores en relación a la trayecto¬ 
ria deseada. La figura 9.9 muestra un diagrama de bloques de nuestro controlador de 
seguimiento de trayectorias. 

Si nuestro modelo es perfecto (es decir, conocemos de m, b y k) y si no hay ruido 
ni error inicial, el bloque seguirá con exactitud la trayectoria deseada. Si hay un error 
inicial, éste se suprimirá de acuerdo con la ecuación (9.52), y de ahí en adelante, el sis¬ 
tema seguirá la trayectoria con exactitud. 



FIGURA 9.9: Un controlador de seguimiento de trayectoria para el sistema de la figura 9.6. 
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9.7 RECHAZO DE PERTURBACIONES 

Uno de los propósitos de un sistema de control es proporcionar un rechazo de perturba¬ 
ciones, esto es, para mantener un buen rendimiento (es decir, minimizar errores) aun en 
presencia de ciertos disturbios externos o ruido. En la figura 9.10 mostraremos el contro¬ 
lador de seguimiento de trayectorias con una entrada adicional: una fuerza perturbadora 
/ dist . Un análisis de nuestro sistema de lazo cerrado nos lleva a la ecuación de error: 

e + k v¿ + k p e = /dist • (9-53) 

La (9.53) es una ecuación diferencial controlada por una función de fuerza. Si se 
sabe que / dist está delimitada; es decir, que existe una constante a tal que 

max/ d i st (í) < a, (9.54) 

entonces la solución de la ecuación diferencial e(t) también está delimitada. Este resul¬ 
tado se debe a una propiedad de los sistemas lineales estables conocida como estabili¬ 
dad de entrada delimitada, salida delimitada o BIBO [3, 4], Este resultado bastante 
básico asegura que, para una clase extensa de posibles perturbaciones, podemos por lo 
menos estar seguros que el sistema permanecerá estable. 

Error de estado estable 

Consideremos el tipo de perturbación más simple; a saber, que / di sea una constante. 
En este caso podemos realizar un análisis de estado estable con el sistema en su estado 
inactivo (es decir, cuando las derivadas de todas las variables del sistema son iguales a 
cero). Si hacemos las derivadas iguales a cero en la ecuación (9.53) se produce la si¬ 
guiente ecuación de estado estable: 

V = /dist- (9.55) 

O 

e = /dist/v (9.56) 

El valor de e dado por la ecuación (9.56) representa un error de estado estable. Por en¬ 
de, queda claro que entre mayor sea la ganancia de posición k p , menor será el error de 
estado estable. 



FIGURA 9.10: Un sistema de control de seguimiento de trayectorias en donde actúa una 
perturbación. 
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Adición de un término integral 

Para eliminar el error de estado estable, algunas veces se utiliza una ley de control mo¬ 
dificada. La modificación implica agregar un término integral a la ley de control, la cual 
se convierte en 


/' = x¿ + k v e + k p e + k¡ J edt, (9-57) 

lo que produce la siguiente ecuación de error: 

e + k v é + k p e + k¡ J edt = / dist . (9.58) 

El término se agrega para que el sistema no tenga un error de estado estable en pre¬ 
sencia de perturbaciones constantes. Si e(t) — 0 para t < 0, podemos escribir la ecuación 
(9.58) para t > 0 como 

e + k v e + k p é + k¡e = / dist , (9.59) 

la que, en el estado estable (para una perturbación constante) se convierte en 

k¡e = 0, (9.60) 

de manera que 

e = 0. (9.61) 

Con esta ley de control, el sistema se convierte en un sistema de tercer orden y se 
puede resolver la ecuación diferencial correspondiente (de tercer orden) para encon¬ 
trar la respuesta del sistema a las condiciones iniciales. A menudo, k ¡ se mantiene 
considerablemente pequeña de manera que el sistema de tercer orden esté “cerca” del 
sistema de segundo orden sin este término (es decir, que puede realizarse un análisis de 
polos dominantes). La forma de la ley de control (9.57) se llama ley de control PID, o 
ley de control “proporcional, integral, derivada” [4]. Por simplicidad, en las leyes de 
control que desarrollamos en este libro las ecuaciones generalmente no muestran un 
término integral. 

9.8 COMPARACIÓN ENTRE CONTROL DE TIEMPO CONTINUO Y DISCRETO 

En los sistemas de control que hemos visto hemos supuesto implícitamente que la compu¬ 
tadora de control realiza el cálculo de la ley de control en tiempo cero (es decir, infini¬ 
tamente rápido), de manera que el valor de la fuerza accionadora / es una función 
continua de tiempo. Desde luego que en la realidad este cálculo requiere de cierto 
tiempo, y la fuerza comandada resultante es por lo tanto una función discreta de “es¬ 
calera”. Emplearemos esta aproximación de una computadora de control muy veloz a 
lo largo del libro. Esta aproximación es aceptable si la velocidad a la que se calculan los 
nuevos valores de / es mucho más rápida que la frecuencia natural del sistema que se 
está controlando. Al analizar el sistema [3] en el campo de control de tiempo discreto 
o control digital no se hace esta aproximación, sino que se toma en cuenta la velocidad 
de servo del sistema de control. 

De manera general supondremos que los cálculos pueden realizarse lo suficiente¬ 
mente rápido como para que nuestra suposición de tiempo continuo sea válida. Aquí 
surge una pregunta: ¿Qué tan rápido es suficiente? Hay varios puntos que necesitamos 
tener en cuenta al elegir una velocidad de servo (o muestra) lo suficientemente rápida: 
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Rastreo de entradas de referencia: El contenido de frecuencia de la entrada deseada o 
de referencia impone un límite inferior absoluto en la frecuencia de muestreo, 
que debe ser por lo menos el doble del ancho de banda de las entradas de refe¬ 
rencia. Por lo general este factor no es limitante. 

Rechazo de perturbaciones: En el rechazo de perturbaciones se proporciona un límite 
superior en el rendimiento mediante un sistema de tiempo continuo. Si el perio¬ 
do de muestreo es mayor que el tiempo de correlación de los efectos de la pertur¬ 
bación (suponiendo un modelo estadístico para disturbios aleatorios), entonces 
estos disturbios no se suprimirán. Una buena regla empírica es que el periodo de 
muestreo debe ser 10 veces más corto que el tiempo de correlación del ruido [3]. 
Control de alias: Siempre que se utilice un sensor análogo en un esquema de control di¬ 
gital habrá un problema con el efecto alias (aquél que produce la confusión de di¬ 
ferentes señales continuas cuando se les muestrea a una frecuencia demasiado 
baja), a menos que la salida del sensor esté estrictamente limitada en banda. En la 
mayoría de los casos, los sensores no tienen una salida limitada en banda, por lo que 
debe elegirse la proporción de muestreo de manera que la cantidad de energía que 
aparezca en la señal con alias sea pequeña. 

Resonancias estructurales: En nuestra caracterización de la dinámica de un manipula¬ 
dor no hemos incluido modos de doblamiento. Todos los mecanismos reales tienen 
una rigidez finita y están sujetos a varios tipos de vibraciones. Si es importante su¬ 
primir estas vibraciones (y a menudo lo es), debemos elegir una velocidad de 
muestreo de cuando menos el doble de la frecuencia natural de estas resonancias. 
(Regresaremos al tema de la resonancia más adelante en este capítulo). 

9.9 MODELADO Y CONTROL DE UNA SOLA ARTICULACIÓN 

En esta sección desarrollaremos un modelo simplificado de una articulación giratoria 
individual de un manipulador. Haremos algunas suposiciones que nos permitirán mo¬ 
delar el sistema resultante como un sistema lineal de segundo orden. Para un modelo 
más completo de una articulación accionada, vea la referencia [5], 

Un actuador común que se encuentra en muchos robots industriales es el motor 
de par de torsión de corriente directa (CD) (como el de la figura 8.18). La parte no gi¬ 
ratoria del motor (el estator) consiste de una cubierta, varios cojinetes e imanes perma¬ 
nentes o bien electroimanes. Estos imanes del estator establecen un campo magnético 
sobre la parte giratoria del motor (el rotor). El rotor consiste de un eje y devanados a 
través de los cuales pasa la corriente para energizar el motor. La corriente se conduce 
hacia los devanados mediante escobillas, las cuales hacen contacto con el conmutador. 
El conmutador está cableado a los diversos devanados (también conocidos como arma¬ 
dura) de tal forma que siempre se produzca un momento de torsión en la dirección de¬ 
seada. El fenómeno físico subyacente [6] que hace que un motor genere un momento 
de torsión cuando la corriente pasa a través de los devanados puede expresarse como 

F = qVxB , (9.62) 

en donde la carga q, que se desplaza con una velocidad V a través de un campo mag¬ 
nético B, experimenta una fuerza F. Las cargas son las de los electrones que se mueven 
a través de los devanados, y el campo magnético es el que establecen los imanes del es¬ 
tator. Generalmente, la habilidad de un motor para producir momentos de torsión se 
define mediante una constante de par de motor individual, la cual relaciona la corrien¬ 
te de la armadura con el momento de torsión de salida como 
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T m = k m ia- (9-63) 

Cuando un motor está girando actúa como un generador, y se desarrolla un voltaje so¬ 
bre la armadura. Una segunda constante del motor, llamada constante fem inversa, 3 
describe el voltaje generado para una velocidad de rotación dada: 

v = k e 6 m . (9.64) 

El hecho de que el conmutador esté cambiando la corriente a través de varios conjun¬ 
tos de devanados generalmente hace que el momento de torsión producido contenga 
cierto rizo de momento de torsión. Aunque algunas veces es importante, por lo gene¬ 
ral este efecto puede ignorarse. (En cualquier caso es muy difícil de modelar; además 
que es complicado hacer una compensación del mismo, aún si se modela). 


Inductancia de la armadura del motor 

La figura 9.11 muestra el circuito eléctrico de la armadura. Los principales componen¬ 
tes son una fuente de voltaje (v a ), la inductancia de los devanados de la armadura (/J, 
la resistencia de los devanados de la armadura (r a ) y la fem inversa generada, v. El cir¬ 
cuito está descrito por una ecuación diferencial de primer orden: 

l Ja + Va = V a ~ Mm' (9-65) 


Por lo general es deseable controlar el momento de torsión generado por el motor (en 
vez de la velocidad) con circuitos electrónicos de accionamiento. Estos circuitos de con¬ 
trol detectan la comente que pasa a través de la armadura y ajustan continuamente la 
fuente de voltaje v a de manera que fluya una comente i a deseada a través de la arma¬ 
dura. Dicho circuito se conoce como controlador de motor amplificador de comente 
[7]. En estos sistemas de control de comente, la velocidad a la que la comente de la ar¬ 
madura puede hacerse cambiar está limitada por la inductancia del motor l a y por un lí¬ 
mite superior en la capacidad de voltaje de la fuente de voltaje v . El efecto neto es el 
de un filtro pasa!)ajos entre la comente solicitada y el momento de torsión de salida. 

Nuestra primera suposición simplificada es que la inductancia del motor puede 
ignorarse. Esta es una suposición razonable cuando la frecuencia natural del sistema de 
control de lazo cerrado es considerablemente baja en comparación con la frecuencia 
de corte del filtro pasabajos implícito en los circuitos de control de comente (debido a 
la inductancia). Esta suposición, junto con la de que el rizo del momento de torsión es 
un efecto que puede ignorarse, significa que podemos en principio comandar el mo¬ 
mento de torsión de manera directa. Aunque tal vez tuviéramos que lidiar con un fac¬ 
tor de escala (como k m ), supondremos que el actuador actúa como una fuente pura de 
momento de torsión que podemos comandar de manera directa. 


rA 1 a 



FIGURA 9.11: El circuito de la armadura de un motor de par de torsión de CD. 


3 “fem” significa fuerza electromotriz. 
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FIGURA 9.12: Modelo mecánico de un motor de par de torsión de CD conectado por me¬ 
dio de engranajes a una carga inercial. 

Inercia efectiva 

La figura 9.12 muestra el modelo mecánico del rotor de un motor de par de torsión de 
CD conectado a través de un engranaje a una carga inercial. El momento de torsión 
aplicado al rotor, r , está dado por la ecuación (9.63) como una función de la corrien¬ 
te i que fluye en el circuito de la armadura. La razón de engranaje (-q) produce un 
incremento en el momento de torsión visto en la carga, y una reducción en la velocidad 
de la carga, dados por 

T = Ubn- 

Ó = a/ri)é m , (9.66) 

en donde rj > 1. Si escribimos un balance de momentos de torsión para este sistema en 
términos del momento de torsión en el rotor se produce la siguiente ecuación: 

= lJ m + bj m + (1/U) {10 + bé) , (9.67) 

en donde / e / son las inercias del rotor del motor y de la carga, respectivamente, y b m 
y b son los coeficientes de fricción viscosa para el rotor y los cojinetes de la carga, res¬ 
pectivamente. Utilizando las relaciones (9.66) podemos escribir la ecuación (9.67) en 
términos de variables del motor: 

r m = (im + 0m + (b m + 9 m (9.68) 

o en términos de variables de carga: 

t = (I + rplje + (b+ rfb m )9. (9-69) 

El término I + q 2 I m algunas veces se conoce como la inercia efectiva “vista” en la 
salida (lado del vínculo) del engranaje. De igual forma, el término b + q 2 b m puede lla¬ 
marse amortiguamiento efectivo. Observe que en una articulación con alta razón de en¬ 
granaje (es decir, que y>> 1), la inercia del rotor del motor puede ser una porción 
considerable de la inercia efectiva combinada. Este efecto es el que nos permite suponer 
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que la inercia efectiva es una constante. Sabemos, del capítulo 6, que la inercia I de una 
articulación del mecanismo varía con la configuración y la carga. No obstante, en ro¬ 
bots con altas razones de engranaje las variaciones representan un porcentaje más 
pequeño que en un manipulador de control directo (es decir, cuando r¡ = 1). Para ase¬ 
gurar que el movimiento del vínculo del robot nunca esté subamortiguado, el valor uti¬ 
lizado para I debe ser el máximo del rango de valores que reciba /; a este valor le 
llamaremos I máx . Esta elección produce un sistema que está críticamente amortiguado 
o sobreamortiguado en todas las situaciones. En el capítulo 10 trataremos la inercia va¬ 
riante directamente y no tendremos que hacer esta suposición. 


EJEMPLO 9.6 

Si la inercia aparente del vínculo, /, varía entre 2 y 6 Kg-m 2 , la inercia del rotor es 
I = 0.01 y la proporción de engranajes es — 30, ¿cuáles son los valores mínimo y 
máximo de la inercia efectiva? 

La inercia efectiva mínima es 

/ mín + 1 2 I m = 2-0 + (900) (0.01) = 11.0; (9.70) 

la máxima es 

Anáx + 0 2 t m = 6.0 + (900) (0.01) = 15.0. (9.71) 

Por ende, podemos ver que, como un porcentaje de la inercia efectiva total, la varia¬ 
ción de la inercia se reduce mediante el engranaje. 


Flexibilidad no modelada 

La otra suposición importante que hemos hecho en nuestro modelo es que el engranaje, 
los ejes, los cojinetes y el vínculo controlado no son flexibles. En realidad todos estos ele¬ 
mentos tienen una rigidez finita, y si se modelara su flexibilidad se incrementaría el orden 
del sistema. El argumento para ignorar los efectos de la flexibilidad es que, si el sistema es 
lo suficientemente rígido, las frecuencias naturales de estas resonancias no modeladas son 
muy altas y pueden ignorarse en comparación con la influencia de los polos dominantes 
de segundo orden que hemos modelado. 4 * El término “no modelado" se refiere al hecho de 
que, para los fines del análisis y diseño de sistemas de control, ignoramos estos efectos y 
utilizamos un modelo dinámico más simple, tal como la ecuación (9.69). 

Como hemos optado por no modelar las flexibilidades estructurales en el sistema, 
debemos tener cuidado de no excitar estas resonancias. Una regla empírica [8] es que 
si la resonancia estructural más baja es co entonces debemos limitar nuestra frecuen¬ 
cia natural de lazo cerrado de acuerdo con 

< ^«res- ( 9 - 72 ) 

Esto proporciona cierta guía sobre cómo seleccionar las ganancias en nuestro contro¬ 
lador. Hemos visto que al incrementar las ganancias se produce una respuesta más rá¬ 
pida y un error de estado estable más bajo, pero ahora vemos que las resonancias 
estructurales no modeladas limitan la magnitud de las ganancias. Los manipuladores 
industriales comunes tienen resonancias estructurales en el rango de 5 a 25 Hz [8]. Los 


4 Éste es básicamente el mismo argumento que utilizamos para ignorar el polo debido a la inductancia 

del motor. Si lo hubiéramos incluido también se hubiera elevado el orden del sistema en general. 
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diseños recientes que utilizan arreglos de accionamiento directo y que no contienen fle¬ 
xibilidad introducida por sistemas de reducción y de transmisión tienen sus resonancias 
estructurales más bajas hasta en 70 Hz [9]. 


EJEMPLO 9.7 

Considere el sistema de la figura 9.7 con los valores de parámetros m = l,b = lyk=l. 
Además se sabe que la resonancia no modelada más baja del sistema se encuentra en 
8 radianes/segundo. Encuentre a, / y las ganancias k p y k v para una ley de control de 
posición de forma que el sistema esté críticamente amortiguado, que no excite la diná¬ 
mica no modelada y que tenga la rigidez de lazo cerrado más alta posible. 

Elegiremos 

a = 1 , 


P = x + x, (9.73) 

de manera que el sistema aparezca como una masa unitaria de la entrada ficticia/'. Uti¬ 
lizando nuestra regla empírica (9.72), elegimos la frecuencia natural de lazo cerrado pa¬ 
ra que sea a> n = 4 radianes/segundo. De las ecuaciones (9.18) y (9.46) tenemos que k p 
= m 2 n , por lo que 

k p = 16.0, 

k v = 8.0. (9.74) 


Estimación de la frecuencia resonante 

Las mismas fuentes de flexibilidad estructural que vimos en el capítulo 8 dan origen 
a las resonancias. En cada caso en el que pueda identificarse una flexibilidad estructural 
es posible hacer un análisis aproximado de la vibración resultante si podemos describir 
la masa o inercia efectiva del miembro flexible. Esto se hace aproximando la situación 
mediante un sistema simple de resorte-masa que, según la ecuación (9.20), exhibe la 
frecuencia natural 

co n = y/k/m, (9-75) 

en donde k es la rigidez del miembro flexible y m es la masa equivalente desplazada en 
las vibraciones. 


EJEMPLO 9.8 

Un eje (se supone sin masa) con una rigidez de 400 Nt-m/radián controla una inercia 
giratoria de 1 Kg-m 2 . Si la rigidez del eje se ignoró al modelar la dinámica, ¿cuál es la 
frecuencia de esta resonancia no modelada? 

Utilizando la ecuación (9.75) tenemos que 

w res = V400/1 = 20 rad/segundos = 20/(2nr)Hz = 3.2 Hz. (9.76) 


Para los fines de una estimación aproximada de la frecuencia resonante más baja 
de vigas y ejes, la referencia [10] sugiere utilizar un modelo concentrado de la masa. Ya 
tenemos fórmulas para estimar la rigidez en los extremos de las vigas y los ejes; estos 
modelos concentrados proporcionan la masa o inercia efectiva necesaria para nuestra 
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FIGURA 9.13: Modelos concentrados de vigas para la estimación de las resonancias lateral 
y torsional más baja. 


estimación de la frecuencia resonante. La figura 9.13 muestra los resultados de un aná¬ 
lisis de energía [10] que sugiere que una viga de masa m sea reemplazada por una ma¬ 
sa puntual en el extremo de 0.23 m y, de igual forma, que una inercia distribuida de I 
sea reemplazada por una inercia concentrada de 0.33 I al final del eje. 


EJEMPLO 9.9 

Un vínculo con una masa de 4.347 Kg tiene una rigidez lateral en su punto más extre¬ 
mo de 3600 Nt/m. Suponiendo que el sistema de control sea completamente rígido, la 
resonancia debida a la flexibilidad del vínculo limitará las ganancias de control. ¿Cuál 
es el valor de a> res ? 

La masa de 4.347 Kg está distribuida a lo largo del vínculo. Utilizando el método 
de la figura 9.13, la masa efectiva es (0.23)(4.347) = 1.0 Kg. Por lo tanto, la frecuencia de 
vibración es 


<u res = y/ 3600/1.0 = 60 radianes/segundos = 60/(27r)Hz = 9.6 Hz. (9.77) 


Hay que incluir las flexibilidades estructurales en el modelo del sistema utilizado pa¬ 
ra la síntesis de la ley de control si deseamos alcanzar anchos de banda de lazo cerrado ma¬ 
yores que los proporcionados por la ecuación (9.75). Los modelos de sistema resultantes 
son de mayor orden, y las técnicas de control aplicables a esta situación se vuelven bastante 
sofisticadas. Dichos esquemas de control se encuentran actualmente más allá de lo más 
avanzado de la práctica industrial, pero son un área activa de investigación [11,12]. 

Control de una sola articulación 

En resumen, haremos las tres siguientes suposiciones principales: 

1. La inductancia del motor I puede ignorarse. 

2. Tomando en cuenta una alta razón de engranaje, modelamos la inercia efectiva 
como una constante igual a I. + n * 1 2 3 /, . 

3. Las flexibilidades estructurales se ignoran, exceptuando que la resonancia estruc¬ 
tural más baja &> se utiliza para establecer las ganancias del servo. 























284 Capítulo 9 


Control lineal de los manipuladores 


Con estas suposiciones, una sola articulación de un manipulador puede controlar¬ 
se con el controlador particionado dado por 


a 1 máx V Im ’ 

/3 = (b + r¡ 2 b m )Ó, 

(9.78) 

x' = Ó d + k v é + k p e. 

(9.79) 

La dinámica de lazo cerrado del sistema resultante es 


e + k v é + k p e = r dist , 

(9.80) 

en donde las ganancias se seleccionan como 


? 1 9 

k n = ay — —co , 


P n 4 res 


k v lJ~kp ®res - 

(9.81) 


9.10 ARQUITECTURA DE UN CONTROLADOR DE ROBOT INDUSTRIAL 

En esta sección veremos brevemente la arquitectura del sistema de control del robot 
industrial Unimation PUMA 560. Como se muestra en la figura 9.14, la arquitectura de 
hardware es la de una jerarquía de dos niveles, con una computadora DEC LSI-11 que 
sirve como la computadora de control “maestro” de nivel superior, la cual pasa los co¬ 
mandos a seis microprocesadores Rockwell 6503. 5 Cada uno de estos microprocesado¬ 
res controla una articulación individual con una ley de control PID parecida a la que 
presentamos en este capítulo. Cada articulación del PUMA 560 está equipada con un 
codificador óptico incremental. Los codificadores tienen una interfaz con un contador 
arriba/abajo, que puede ser leído por el microprocesador para obtener la posición ac¬ 
tual de la articulación. No hay tacómetros en el PUMA 560; las posiciones de las ar¬ 
ticulaciones se diferencian en ciclos de servo subsecuentes para obtener una estimación 
de la velocidad de las articulaciones. Para comandar momentos de torsión a los moto¬ 
res de par de torsión de CD, el microprocesador se conecta a un convertidor digital- 
análogo (D/A) para que se puedan enviar las corrientes del motor a los circuitos 



FIGURA 9.14: Arquitectura computacional jerárquica del sistema de control del robot 
PUMA 560. 

5 Estas computadoras simples de 8 bits son ya una tecnología obsoleta. Actualmente los controladores de 
robots están basados en microprocesadores de 32 bits. 
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FIGURA 9.15: Bloques funcionales del sistema de control de articulaciones del PUMA 560. 


controladores de corriente. La corriente que fluye a través del motor se controla en un 
circuito análogo ajustando el voltaje a través de la armadura según sea necesario para 
mantener la corriente deseada. La figura 9.15 muestra un diagrama de bloques. 

Cada 28 milisegundos la computadora LSI-11 envía un nuevo comando de posición 
(punto de ajuste) a los microprocesadores de las articulaciones. Estos microprocesadores 
están funcionando en un ciclo de 0.875 milisegundos. Durante este tiempo interpolan el 
punto de ajuste de la posición deseada, calculan el error de servo, calculan la ley de con¬ 
trol PID y ordenan un nuevo valor de momento de torsión a los motores. 

La computadora LSI-11 se encarga de todas las operaciones de “alto nivel” del 
sistema de control en general. Primero que nada se encarga de interpretar uno por uno 
los comandos del programa en VAL (lenguaje de programación de robots de Unima- 
tion). Cuando se interpreta un comando de movimiento, la computadora LSI-11 debe 
realizar todos los cálculos necesarios de cinemática inversa, planear una trayectoria de¬ 
seada y empezar a generar puntos vía de la trayectoria cada 28 milisegundos para los 
controladores de las articulaciones. 

La computadora LSI-11 también está conectada con periféricos estándar tales co¬ 
mo la terminal y una unidad de disco flexible. Además está conectada a un dispositivo 
de enseñanza, que es una caja portátil de botones que permite al operador mover el ro¬ 
bot en varios modos. Por ejemplo, el sistema del PUMA 560 permite al usuario mover 
el robot de manera incremental, en las coordenadas de las articulaciones o en las coor¬ 
denadas cartesianas desde el dispositivo de enseñanza. En este modo, los botones del 
dispositivo de enseñanza hacen que se calcule una trayectoria “al instante”, la cual se 
pasa a los microprocesadores de control de las articulaciones. 
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EJERCICIOS 

9.1 [20] Para una ecuación diferencial de segundo orden con raíces complejas 

íj = X + gti, 
s 2 = I — gti, 

demuestre que la solución general 

x(t) = c^ 1 + c 2 e s *, 

puede escribirse así: 

x(t) = c x e Xt eos (ptt) + c 2 e Xt sen {ptt). 

9.2 [13] Calcule el movimiento del sistema de la figura 9.2 si los valores de los parámetros 
son m = 2, b = 6 y k = 4, y si el bloque (inicialmente en reposo) se libera desde la po¬ 
sición x = 1. 

9.3 [13] Calcule el movimiento del sistema de la figura 9.2 si los valores de los parámetros 
son m = l,fc = 2yfc = l,ysiel bloque (inicialmente en reposo) se libera desde la po¬ 
sición x = 4. 

9.4 [13] Calcule el movimiento del sistema de la figura 9.2 si los valores de los parámetros 
son m = 1, b = 4 y k = 5, y si el bloque (inicialmente en reposo) se libera desde la po¬ 
sición x = 2. 

9.5 [15] Calcule el movimiento del sistema de la figura 9.2 si los valores de los parámetros 
son m = 1, b = 7 y k = 10, y si el bloque se libera desde la posición x = 1 con una ve¬ 
locidad inicial de v = 2. 

9.6 [15] Use el elemento (1,1) de la ecuación (6.60) para calcular la variación (como un 
porcentaje del valor máximo) de la inercia “vista” por la articulación 1 de este robot 
a medida que cambia de configuración. Use los valores numéricos 


l 1 = Z 2 = 0.5 m, 
m ] = 4.0 Kg, 
m 2 = 2.0 Kg. 
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Considere que el robot es de accionamiento directo y que la inercia del rotor puede 
ignorarse. 

9.7 [17] Repita el ejercicio 9.6 para el caso de un robot con engranajes (use = 20) y una 
inercia del rotor de I = 0.01 Kg-m 2 . 

9.8 [18] Considere el sistema de la figura 9.6 con los valores de parámetros m = 1, b = 4 
y k = 5. También se sabe que el sistema posee una resonancia no modelada a a> res = 
6.0 radianes/segundo. Determine las ganancias k v y k que amortigüen críticamente el 
sistema con una rigidez tan alta como sea razonable. 

9.9 [25] En un sistema como el de la figura 9.12, la carga inercial I varía entre 4 y 5 Kg-m 2 . 
La inercia del rotor es I = 0.01 Kg-m 2 y la proporción de engranajes es r¡ = 10. El siste¬ 
ma posee resonancias no modeladas a 8.0,12.0 y 20.0 radianes/segundo. Diseñe ay/i del 
controlador particionado y proporcione los valores de k p y k v tales que el sistema nunca 
esté subamortiguado y nunca excite resonancias, pero que sea lo más rígido posible. 

9.10 [18] Un diseñador de un robot de accionamiento directo sospecha que la resonancia 
debida a la flexibilidad de las vigas del vínculo en sí será la causa de la resonancia no 
modelada más baja. Si el vínculo es aproximadamente una viga de corte transversal 
cuadrado de dimensiones 5 x 5 x 50 cm, con grosor de pared de 1 cm y una masa to¬ 
tal de 5 Kg, estime el valor de a> res . 

9.11 [15] El vínculo de un robot de accionamiento directo se controla a través de un eje con 
una rigidez de 1000 Nt-m/radián. La inercia del vínculo es de 1 Kg-m 2 . Suponiendo 
que el eje no tenga masa, ¿cuál es el valor de a> res ? 

9.12 [18] Un eje con una rigidez de 500 Nt-m/radián controla la entrada de un par de en¬ 
granajes rígidos con ij = 8 . La salida de los engranajes controla un vínculo rígido con 
una inercia de 1 Kg-m 2 . ¿Cuál es la « res ocasionada por la flexibilidad del eje? 

9.13 [25] Un eje con una rigidez de 500 Nt-m/radián controla la entrada de un par de en¬ 
granajes rígidos con >7 = 8 . El eje tiene una inercia de 0.1 Kg-m 2 . La salida de los 
engranajes controla un vínculo rígido con una inercia de 1 Kg-m 2 . ¿Cuál es la « res 
ocasionada por la flexibilidad del eje? 

9.14 [28] En un sistema como el de la figura 9.12, la carga inercial I varía entre 4 y 5 Kg- 
m 2 . La inercia del rotor es / = 0.01 Kg-m 2 y la proporción de engranajes es r¡ = 10. 
El sistema posee una resonancia no modelada debida a la rigidez de un punto del ex¬ 
tremo del vínculo de 2400 Nt-m/radián. Diseñe ay P del controlador particionado y 
proporcione los valores de k y k v tales que el sistema nunca esté subamortiguado 
y nunca excite resonancias, pero que sea lo más rígido posible. 

9.15 [25] Un eje de acero con una longitud de 30 cm y un diámetro de 0.2 cm controla el en¬ 
granaje de entrada de una reducción de í; = 8 . El engranaje de salida rígido controla un 
eje de acero con una longitud de 30 cm y un diámetro de 0.3 cm. ¿Cuál es el rango de 
frecuencias resonantes que se observan si la inercia de la carga varía entre 1 y 4 Kg-m 2 ? 

EJERCICIO DE PROGRAMACIÓN (PARTE 9) 

Deseamos simular un sistema de control simple de seguimiento de trayectorias para un bra¬ 
zo planar de tres vínculos. Este sistema de control se implementará como una ley de con¬ 
trol PD (proporcional derivativo) de articulación independiente. Ajuste las ganancias del 
servo para lograr rigideces de lazo cerrado de 175.0, 110.0 y 20.0 para las articulaciones 1 a 
3, respectivamente. Trate de lograr un amortiguamiento crítico aproximado. 

Use la rutina de simulación ACTUALIZA para simular un servo de tiempo discreto 
ejecutándose a 100 Hz; esto es, calcule la ley de control a 100 Hz, no a la frecuencia del pro¬ 
ceso de integración numérica. Pruebe el esquema de control con los siguientes ejercicios. 

1. Inicie el brazo en 0 = (60, —110, 20) y ordénele quedarse ahí hasta que tiempo = 3.0, 
cuando los puntos de ajuste deban cambiar instantáneamente a 0 = (60, —50,20). Es¬ 
to es, proporcione una entrada de escalón de 60 grados para la articulación 2. Regis¬ 
tre el historial de error-tiempo para cada articulación. 
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2. Controle el brazo para que siga la trayectoria de trazador cúbico del ejercicio de pro¬ 
gramación, parte 7. Registre el historial de error -tiempo para cada articulación. 

EJERCICIO MATLAB 9 

Este ejercicio se enfoca en la simulación del control de articulación independiente lineali- 
zado para la articulación tipo hombro (articulación 2) del brazo manipulador AAI ARMIII 
(Manipulador de Investigación Avanzada II) de ocho ejes de la NASA; vea la referencia [14]. 
Se supone una familiaridad con los sistemas de control de retroalimentación clásicos li¬ 
neales, incluyendo los diagramas de bloque y las transformadas de Laplace. Utilizaremos 
Simulink, la interfaz gráfica de usuario de MATLAB. 

La figura 9.16 muestra el modelo dinámico de un sistema de lazo abierto linealizado 
para la articulación/vínculo de hombro electromecánico del ARMII, accionada por un ser¬ 
vomotor de armadura-controlador de CD. La entrada de lazo abierto es el voltaje de refe¬ 
rencia V ref (incrementado hasta el voltaje de la armadura mediante un amplificador), y la 
salida de interés es el ángulo del eje de carga, ThetaL. La figura también muestra el diagra¬ 
ma de control de retroalimentación, en donde el ángulo del eje de carga se detecta median¬ 
te un codificador óptico y se proporciona como retroalimentación al controlador PID. La 
tabla describe todos los parámetros y las variables del sistema. 

Si reflejamos la inercia y el amortiguamiento del eje de carga al eje del motor, los coefi¬ 
cientes de inercia polar efectiva y de amortiguamiento son J = J M + J L ( t)ln 2 y C = C M + C L ln 2 . 
En virtud de la gran razón de engranaje n, estos valores efectivos no son muy distintos de 
los valores del eje del motor. Por lo tanto, la razón de engranaje nos permite ignorar las va¬ 
riaciones en la inercia del eje de carga dependiente de la configuración .1 L (t) y sólo estable¬ 
cer un valor promedio razonable. 

Los parámetros constantes de la articulación tipo hombro del ARMII aparecen en la 
tabla que se muestra a continuación [13]. Observe que podemos usar las unidades inglesas 
directamente ya que su efecto se cancela dentro del diagrama de control. Además podemos 
usar directamente unidades de grados para el ángulo. Desarrolle un modelo en Simulink 
para simular el modelo de control de una articulación a partir del diagrama de control 




Diagrama de control de retroalimentación de lazo cerrado 

FIGURA 9.16: Modelo dinámico del sistema de lazo abierto linealizado para la articu¬ 
lación/vínculo de hombro electromecánico del ARMII, accionada por un servomotor 
de CD de armadura-controlador. 
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Voltaje de la 
armadura 

r Aí(0 

Par de torsión 
de motor 
generado 

t l(0 

Momento de 
torsión de la 
carga 

L = 0.0006 H 

Inductancia 
de la 

armadura 

yo 

Angulo del eje 
del motor 

e L (t) 

Angulo del eje 
de carga 

R = 1.40Q 

Resistencia 
de la 

armadura 

"m( o 

Velocidad del 
eje del motor 

®l(0 

Velocidad del 
eje de carga 

¿«(0 

Corriente de 
la armadura 

J M = 0.00844 
Ib, -pulg-s 2 

Inercia polar 
concentrada 
de motor 

4(0 = i 
lb^ -pulg-s z 

Inercia polar 
concentrada de 
carga 


Voltaje de 
fem inversa 

C M = 0.00013 

lby—pUlg/ 

grad/seg 

Coeficiente de 
amortiguamien¬ 
to viscoso del 
eje del motor 

C L = 0.5 Ib, 
-pulg/gradí 
seg 

Coeficiente de 
amortiguamien¬ 
to viscoso del 
eje de carga 

K a = 12 

Ganancia del 
amplificador 

n = 200 

Razón de 
engranaje 

g = 0 

pulg/s 2 

Gravedad 
(ignore la 
gravedad al 
principio) 

K h = 0.00867 
V/grad/s 

Constante de 
fem inversa 

K m = 4.375 
lb^ -pulg/A 

Constante de 
momento de 
torsión 

K e = 1 

Función de 
transferencia 
de codificador 


retroalimentado y del modelo que se muestra; use los parámetros específicos de la tabla. Pa¬ 
ra el caso nominal, determine las ganancias PID mediante prueba y error para un “buen” 
rendimiento (porcentaje razonable de sobredisparo, tiempo de subida, tiempo pico y tiem¬ 
po de establecimiento). Simule el movimiento resultante para mover esta articulación tipo 
hombro para una entrada escalón de 0 a 60 grados. Trace el valor simulado del ángulo de 
carga sobre el tiempo, y también la velocidad angular del eje de carga sobre el tiempo. 
Además, trace el esfuerzo de control; esto es, el voltaje de armadura V sobre el tiempo. (En 
la misma gráfica, también proporcione la fem inversa V b ). 

Ahora pruebe algunos cambios; es muy fácil y entretenido cambiar en Simulink: 

1) La entrada en escalón es frustrante para el diseño de controladores, así que pruebe 
mejor una entrada en escalón tipo rampa: suba uniformemente de 0 a 60 grados en 
1.5 segundos y después sostenga el comando de 60 grados durante todo el tiempo ma¬ 
yor de los 1.5 seg. Rediseñe las ganancias PID y vuelva a estimular. 

2) Investigue si el inductor L es significativo en este sistema. (El sistema eléctrico se ele¬ 
va mucho más rápido que el sistema mecánico; este efecto puede representarse me¬ 
diante constantes de tiempo). 

3) No tenemos una buena estimación para la inercia de carga y el amortiguamiento (J L 
y C L ). Con sus mejores ganancias PID de antes, investigue qué tanto pueden crecer 
estos valores (escale los parámetros nominales hacia arriba por igual) antes de que 
afecten al sistema. 

4) Ahora incluya el efecto de la gravedad como una perturbación para el par de motor 
T m . Suponga que la masa del robot en movimiento es de 200 Ib y que la longitud mó¬ 
vil más allá de la articulación 2 es de 6.4 pies. Pruebe buscando las ganancias PID 
“buenas” nominales que encontró; vuelva a diseñar si es necesario. La configuración 
en ceros del ángulo de carga 0 2 tipo hombro es directamente hacia arriba. 
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10.1 INTRODUCCIÓN 

En el capítulo 9 hicimos varias aproximaciones para permitir un análisis lineal del pro¬ 
blema del control de manipuladores; la más importante fue que cada articulación 
podía considerarse independiente y que la inercia “vista” por cada actuador de articu¬ 
lación era constante. En implementaciones de controladores lineales, como los que se 
presentaron en el capítulo anterior, esta aproximación produce un amortiguamiento no 
uniforme a lo largo del espacio de trabajo y otros efectos indeseables. En este capítulo 
presentaremos una técnica de control más avanzada para la cual no habrá que hacer es¬ 
ta suposición. 

En el capítulo 9 modelamos el manipulador mediante n ecuaciones diferenciales 
independientes de segundo orden y basamos nuestro controlador en ese modelo. En es¬ 
te capítulo basaremos nuestro diseño del controlador directamente en la ecuación dife¬ 
rencial del vector no lineal de n x 1 del movimiento, derivada en el capítulo 6 para un 
manipulador general. 

El campo de la teoría de control no lineal es extenso; por lo tanto debemos res¬ 
tringir nuestra atención a uno o dos métodos que parecen adaptarse bien a los manipu¬ 
ladores mecánicos. Por consecuencia, nuestro mayor énfasis aquí será sobre un método 
específico, que aparentemente se propuso por primera vez en la referencia [1] y al que 
se nombró método de momento de torsión calculado en [2, 3]. También presentaremos 
un método de análisis de estabilidad de sistemas no lineales, conocido como el método 
de Lyapunov [4], 

Comenzaremos nuestro examen de las técnicas no lineales para controlar un ma¬ 
nipulador, para lo cual regresamos a un sistema de fricción tipo masa-resorte muy sim¬ 
ple, con un solo grado de libertad. 
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10.2 SISTEMAS NO LINEALES Y VARIANTES EN EL TIEMPO 

En el desarrollo anterior tratamos con una ecuación diferencial lineal de coeficientes 
constantes. Esta forma matemática surgió porque el sistema de fricción tipo masa-re¬ 
sorte de la figura 9.6 se modeló como un sistema lineal invariante en el tiempo. Para 
sistemas cuyos parámetros varían en el tiempo, o sistemas que por naturaleza son no li¬ 
neales, las soluciones son más difíciles. 

Cuando las no linealidades no son severas, puede utilizarse la linealización local pa¬ 
ra derivar modelos lineales que son aproximaciones de las ecuaciones no lineales en ubi¬ 
caciones adyacentes a un punto de operación. Desafortunadamente, el problema del 
control de manipuladores no se adapta bien a este método, ya que los manipuladores se 
mueven constantemente a lo largo de regiones de su espacio de trabajo tan ampliamen¬ 
te separadas que no puede encontrarse una linealización válida para todas las regiones. 

Otro método es desplazar el punto de operación con el manipulador a medida que 
se vaya moviendo, siempre linealizando sobre la posición deseada del manipulador. El re¬ 
sultado de este tipo de linealización móvil es un sistema lineal, pero variante en el tiem¬ 
po. Aunque esta linealización casi estática del sistema original es útil en ciertas técnicas 
de análisis y diseño, no la utilizaremos en nuestro procedimiento de síntesis de leyes de 
control; trataremos directamente con las ecuaciones no lineales de movimiento y no re¬ 
curriremos a las linealizaciones para derivar un controlador. 

Si el resorte de la figura 9.6 en lugar de ser lineal tuviera un elemento no lineal, 
podríamos considerar el sistema como casi estático y, en cada instante, averiguar en 
dónde se ubican los polos del sistema. Podríamos descubrir que los polos se “mueven” 
alrededor del plano real - imaginario como una función de la posición del bloque. Por 
lo tanto, no podríamos seleccionar ganancias fijas que mantuvieran a los polos en una 
ubicación deseada (por ejemplo, en amortiguamiento crítico). Entonces podemos ver- 
nos tentados a considerar una ley de control más complicada, en la que las ganancias 
sean variantes en el tiempo (en realidad, varían como una función de la posición del 
bloque) de tal forma que el sistema siempre esté críticamente amortiguado. En esen¬ 
cia, para hacer esto se calcularía k p de tal forma que la combinación del efecto no lineal 
del resorte se cancelara exactamente por un término no lineal en la ley de control, para 
que la rigidez general se mantuviera constante en todo momento. Dicho esquema de con¬ 
trol podría llamarse ley de control de linealización, ya que utiliza un término de control 
no lineal para “cancelar” una no linealidad en el sistema controlado, de forma que el sis¬ 
tema de lazo cerrado en general sea lineal. 

Ahora regresaremos a nuestra ley de control particionado y veremos que puede rea¬ 
lizar esta función de linealización. En nuestro esquema de la ley de control particionado, 
la ley del servo permanece igual que siempre, pero la porción basada en el modelo ahora 
contendrá un modelo de la no linealidad. Por ende, la porción basada en el modelo del con¬ 
trol realiza una función de linealización. Esto se entenderá mejor con un ejemplo. 


EJEMPLO 10.1 

Considere la característica del resorte no lineal mostrada en la figura 10.1. En lugar de 
la relación usual de resorte lineal, / = kx, este resorte se describe mediante / = qx 3 . Si 
este resorte es parte del sistema físico que se muestra en la figura 9.6, construya una ley 
de control para mantener el sistema críticamente amortiguado con una rigidez de k ( ¡ . 
La ecuación de lazo abierto es 

... ' 7 , 

mx + bx + qx = f. 


( 10 . 1 ) 
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FIGURA 10.1: La característica de fuerza vs. distancia de un resorte no lineal. 


La porción del control basada en el modelo es f— af + ¡3, en donde ahora utilizamos 

a = m, 

fi = bx + qx 3 \ (10.2) 

la porción de servo es, como siempre, 

f =x d + k v é + k p e, (10.3) 

en donde los valores de las ganancias se calculan a partir de cierta especificación del ren¬ 
dimiento deseado. La figura 10.2 muestra un diagrama de bloques de este sistema de 
control. El sistema resultante de lazo cerrado mantiene los polos en ubicaciones fijas. 


Sistema 



FIGURA 10.2: Un sistema de control no lineal para un sistema con un resorte no lineal. 
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f= b c SGN (i) 



b c 



FIGURA 10.3: La característica de fuerza vs. velocidad de la fricción de Coulomb. 


EJEMPLO 10.2 

Considere la característica de la fricción no lineal que se muestra en la figura 10.3. 
Mientras que la fricción lineal está descrita por f— bx, esta fricción de Coulomb se des¬ 
cribe mediante f— b c sgn(x). Para la mayoría de los manipuladores actuales, la fricción 
de la articulación en su cojinete (sea giratorio o lineal) se modela con más precisión uti¬ 
lizando esta característica no lineal que con el modelo lineal más simple. Si este tipo de 
fricción está presente en el sistema de la figura 9.6, diseñe un sistema de control que 
utilice una porción basada en el modelo no lineal para amortiguar críticamente al sis¬ 
tema en todo momento. 

La ecuación de lazo abierto es 

mx + b c sgn{x) + kx = f. (10.4) 

La ley de control particionado es /= af + p, en donde 

a — m, 

P — b c sgn(x ) + kx, (10.5) 

f = x d + k v é + k p e. 


en donde los valores de las ganancias se calculan a partir de una especificación de ren¬ 
dimiento deseado. 


EJEMPLO 10.3 

Considere el manipulador de un solo vínculo que se muestra en la figura 10.4; el cual tie¬ 
ne una articulación giratoria. Se considera que la masa está ubicada en un punto del extre¬ 
mo distal del vínculo, por lo que el momento de inercia es mi 2 . Hay fricción de viscosidad 
y de Coulomb actuando en la articulación, y existe una carga debido a la gravedad. 
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FIGURA 10.4: Un péndulo invertido, o un manipulador de un solo vínculo. 


El modelo del manipulador es 

r = ml * 1 2 'Ó + vé + csgn{6) + mlgcos(d). (10.6) 

Como siempre, el sistema de control tiene dos partes: alinealización de la porción de 
basada en el modelo y la porción de la ley del servo. 

La porción del control basada en el modelo es / = af + /3, en donde 

a = mi 2 , 

P = vd + csgn(6) + m/gcos(0); (10.7) 

la porción del servo es, como siempre, 


f'=e d + k v é + k p e, (10.8) 

en donde los valores de las ganancias se calculan a partir de cierta especificación de 
rendimiento deseada. 


Hemos visto que, en ciertos casos simples, no es difícil diseñar un controlador no 
lineal. El método general utilizado en los ejemplos simples antes mencionados es el 
mismo que utilizaremos para el problema de control de manipuladores: 

1. Calcular una ley de control no lineal basada en el modelo que “cancele” las no li- 
nealidades del sistema a controlar. 

2. Reducir el sistema a uno lineal que pueda controlarse con la ley de servo lineal 
simple desarrollada para la masa unitaria. 

En cierto sentido, la ley de control de linealización implementa un modelo inver¬ 
so del sistema que se está controlando. Las no linealidades del sistema cancelan las del 
modelo inverso; lo cual, en conjunto con la ley de servo, produce un sistema lineal de 
lazo cerrado. Obviamente, para hacer esta cancelación debemos conocer los paráme¬ 
tros y la estructura del sistema no lineal. Esto a menudo representa un problema en la 
aplicación práctica de este método. 
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10.3 SISTEMAS DE CONTROL MULTI ENTRADAS, MULTI SALI DAS 

A diferencia de los ejemplos simples que hemos visto hasta ahora, el problema de con¬ 
trolar un manipulador es un problema de multientradas, multisalidas (MIMO). Es de¬ 
cir, tenemos un vector de posiciones, velocidades y aceleraciones de la articulación 
deseadas, y la ley de control debe calcular un vector de señales de articulación-actua- 
dor. Nuestro esquema básico en el que se particiona la ley de control en una porción 
basada en el modelo y una porción del servo aún puede aplicarse, pero ahora aparece 
en una forma matricial-vectorial. La ley de control toma la forma 

F — olF' + p, (10.9) 

en donde, para un sistema de n grados de libertad, F, F' y fí son vectores de n x 1 y a 
es una matriz de n x n. Observe que la matriz a no es necesariamente diagonal, sino 
que se elige para desacoplar las n ecuaciones de movimiento. Si a y p se seleccionan 
correctamente, entonces, desde la entrada F el sistema parece como si fuera n masas 
unitarias independientes. Por esta razón, en el caso multidimensional la porción basa¬ 
da en el modelo de la ley de control se llama ley de control de linealización y desaco- 
plamiento. La ley de servo para un sistema multidimensional se convierte en 

F' = X d + K V É + K p E, (10.10) 

en donde K v y K son ahora matrices de n x n, que se seleccionan generalmente para 
ser diagonales con ganancia constante en la diagonal. E y É son los vectores den x 1 
de los errores en posición y velocidad, respectivamente. 

10.4 EL PROBLEMA DEL CONTROL PARA LOS MANIPULADORES 

En el caso del control de manipuladores, en el capítulo 6 desarrollamos un modelo y 
las correspondientes ecuaciones de movimiento. Como vimos, esas ecuaciones son bas¬ 
tante complicadas. La dinámica de cuerpo rígido tiene la forma 

r = M(©)@ + V(0, 0) + G(0), (10.11) 

en donde M(& ) es la matriz de inercia de n x n del manipulador, L(©, 0) es un vector 
de n x 1 de términos centrífugos y de Coriolis, y G(@) es un vector de n x 1 de términos 
de gravedad. Cada elemento de M(&) y de G(0) es una función complicada que de¬ 
pende de 0, la posición de todas las articulaciones del manipulador. Cada elemento de 
L(0, 0) es una función complicada tanto de © como de 0. 

Además, podríamos incorporar un modelo de fricción (u otros efectos de cuerpos 
no rígidos). Suponiendo que nuestro modelo de fricción es una función de las posicio¬ 
nes y las velocidades de las articulaciones, agregamos el término F( 0,0) a la ecuación 
(10.11) para producir el modelo 

r = M(0)0 + V(0, 0) + G(0) + F(0, 0). (10.12) 

El problema de controlar un sistema complicado, como el de la ecuación (10.12), 
puede manejarse mediante el esquema del controlador particionado que hemos pre¬ 
sentado en este capítulo. En este caso, tenemos que 

r = olx' + p, (10.13) 

en donde r es el vector de n x 1 de momentos de torsión de las articulaciones. Elegi¬ 
mos lo siguiente: 


a = M(0), 

P = V(0, 0) + G(0) + F(&, 0), 


(10.14) 
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FIGURA 10.5: Un sistema de control de manipulador basado en el modelo, 
con la ley de servo 

r' = & d + K V É + K p E, (10.15) 

en donde 

E = @ d -@. (10.16) 

El sistema de control resultante se muestra en la figura 10.5. 

Utilizando las ecuaciones (10.12) a (10.15), es muy fácil demostrar que el sistema 
de lazo cerrado está caracterizado por la ecuación de error 

É + K V É + K p E = 0. (10.17) 

Observe que esta ecuación vectorial está desacoplada: las matrices K v y K p son diago¬ 
nales, de manera que la ecuación (10.17) podría escribirse también con base en cada 
articulación de la siguiente forma: 

e i +kv ¡ é + k pi e = 0. (10.18) 

El rendimiento ideal, representado por la ecuación (10.17), no puede obtenerse en la 
práctica por diversas razones, entre las cuales las más importantes son: 

1. La naturaleza discreta de una implementación en computadora digital, a diferen¬ 
cia de la ley de control ideal de tiempo continuo implicada por las ecuaciones 

(10.14) y (10.15). 

2. Imprecisión en el modelo del manipulador [necesario para evaluar la ecuación 

(10.14) ]. 

En la siguiente sección trataremos (al menos parcialmente) estos dos temas. 

10.5 CONSIDERACIONES PRÁCTICAS 

Al desarrollar el control de linealización y desacoplamiento en las últimas secciones, hemos 
hecho implícitamente unas cuantas suposiciones que raras veces son ciertas en la práctica. 

Tiempo requerido para calcular el modelo 

En todas nuestras consideraciones de la estrategia de la ley de control particionado he¬ 
mos supuesto implícitamente que todo el sistema estaba funcionando en tiempo conti¬ 
nuo y que los cálculos en la ley de control requerían de un tiempo igual a cero. Dada 
cualquier cantidad de cálculos, con una computadora lo suficientemente grande, pode¬ 
mos realizar los cálculos con la suficiente rapidez como para que ésta sea una aproxi- 
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mación razonable; sin embargo, el costo de la computadora podría hacer que el esque¬ 
ma fuera económicamente inviable. En el caso del control del manipulador, toda la 
ecuación dinámica del manipulador (10.14) debe calcularse en la ley de control. Estos 
cálculos son considerablemente complejos; por consecuencia y como se dijo en el capí¬ 
tulo 6, hay un gran interés en desarrollar esquemas computacionales veloces para rea¬ 
lizar los cálculos de una manera eficiente. A medida que el poder de cómputo se vuelva 
cada vez más asequible, las leyes de control que requieran de mucho poder de cómpu¬ 
to se volverán más prácticas. Se han reportado varias implementaciones experimenta¬ 
les de las leyes de control basadas en modelos no lineales [5-9] y las implementaciones 
parciales han empezado a aparecer en controladores industriales. 

Como vimos en el capítulo 9, casi todos los sistemas de control de manipuladores 
operan ahora en circuitos digitales y se ejecutan a cierta velocidad de muestreo. Esto sig¬ 
nifica que los sensores de posición (y posiblemente otros) se leen en puntos discretos en 
el tiempo. De los valores leídos se calcula un comando que se envía al actuador. Por en¬ 
de, las operaciones de lectura de los sensores y del envío de comandos al actuador no se 
hacen continuamente, sino a una velocidad de muestreo finita. Para analizar el efecto 
del retraso debido a los cálculos y la velocidad de muestreo finita, debemos usar herra¬ 
mientas del campo del control de tiempo discreto, en donde las ecuaciones diferenciales 
se convierten en ecuaciones de diferencia, y se ha desarrollado un conjunto completo de 
herramientas para responder a las preguntas sobre estabilidad y colocación de los polos 
para estos sistemas. La teoría de control de tiempo discreto está más allá del alcance de 
este libro, aunque para los investigadores que trabajan en el área del control de mani¬ 
puladores muchos de estos conceptos son esenciales (vea la referencia [10]). 

Aunque son importantes, las ideas y los métodos de la teoría de control de tiem¬ 
po discreto son algo difíciles de aplicar en el caso de los sistemas no lineales. Aunque 
hemos logrado escribir una complicada ecuación diferencial de movimiento para la 
ecuación dinámica de un manipulador, una ecuación equivalente en tiempo discreto 
sería imposible de obtener, ya que para un manipulador general la única manera de re¬ 
solver el movimiento del manipulador para un conjunto dado de condiciones iniciales, 
una entrada y un intervalo finito, es por medio de la integración numérica (como vimos 
en el capítulo 6). Es posible crear modelos de tiempo discreto si estamos dispuestos a 
utilizar soluciones en series para las ecuaciones diferenciales, o si hacemos aproxima¬ 
ciones. No obstante, si necesitamos hacer aproximaciones para desarrollar un modelo 
discreto, no está claro si tenemos un mejor modelo que el que tendríamos si utilizamos 
solamente el modelo continuo y hacemos la aproximación de tiempo continuo. Basta 
decir que es difícil analizar el problema de control de manipuladores en tiempo discre¬ 
to, y por lo general se recurre a la simulación para poder juzgar el efecto que cierta ve¬ 
locidad de muestreo tendrá sobre el rendimiento. 

En general supondremos que los cálculos pueden realizarse lo suficientemente rá¬ 
pido y con la suficiente frecuencia como para que sea válida la aproximación en tiem¬ 
po continuo. 

Control no lineal de alimentación anticipada 

El uso del control de alimentación anticipada se ha propuesto como un método para 
usar un modelo dinámico no lineal en una ley de control sin necesidad de que se reali¬ 
cen cálculos complejos que consuman mucho tiempo a las velocidades de servo [11]. En 
la figura 10.5 la porción de control basada en el modelo de la ley de control está en el 
“ciclo de servo”, en donde las señales “fluyen” a través de la caja negra con cada pulso 
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FIGURA 10.6: Esquema de control con la porción basada en el modelo “fuera” del ciclo 
de servo. 

del reloj del servo. Si deseamos seleccionar una velocidad de muestreo de 200 Hz, en¬ 
tonces el modelo dinámico del manipulador debe calcularse a esa velocidad. Otro po¬ 
sible sistema de control se muestra en la figura 10.6. Aquí el control basado en el 
modelo está “fuera” del ciclo de servo. Por ende, es posible tener un ciclo de servo in¬ 
terno más rápido, que consista simplemente de multiplicar los errores por las ganan¬ 
cias, agregando los momentos de torsión basados en el modelo a una velocidad menor. 

Desafortunadamente, el esquema de alimentación anticipada de la figura 10.6 no 
proporciona un desacoplamiento completo. Si escribimos las ecuaciones del sistema, 1 
encontraremos que la ecuación de error de este sistema es 

É + M~ 1 (®)K V É + M~ 1 (®)K p E = 0. (10.19) 

Evidentemente, a medida que cambie la configuración del brazo cambiará la ganancia 
efectiva de lazo cerrado y los polos casi estáticos se desplazarán en el plano real-imagi¬ 
nario. No obstante, la ecuación (10.19) podría utilizarse como punto de inicio para di¬ 
señar un controlador robusto que encuentre un buen conjunto de ganancias constantes 
de tal forma que, a pesar del “movimiento” de los polos, se garantice que permanezcan 
en ubicaciones razonablemente favorables. Alternativamente podríamos considerar es¬ 
quemas en los que se calculen previamente las ganancias variables que cambien con la 
configuración del robot, de manera que los polos casi estáticos del sistema permanez¬ 
can en posiciones fijas. 

Observe que en el sistema de la figura 10.6, el modelo dinámico se calcula solamen¬ 
te como una función de la ruta deseada, por lo que cuando se conoce de antemano la ru¬ 
ta, los valores pueden calcularse “fuera de línea” antes de que empiece el movimiento. 
En tiempo de ejecución los historiales de momentos de torsión previamente calculados 
se leerían de la memoria. De igual forma, si se calculan ganancias variantes en el tiempo, 
también podrían calcularse de antemano y almacenarse. Por ende, un esquema así podría 
ser considerablemente económico en tiempo de ejecución, hablando en términos compu- 
tacionales, y por lo tanto podría lograr una velocidad de servo alta. 

Implementación de momento de torsión calculado con doble velocidad 

La figura 10.7 muestra el diagrama de bloques de una posible implementación práctica 
del sistema de control de posición de linealización y desacoplamiento. El modelo dinámi¬ 
co se expresa en su forma de espacio de configuración , de tal forma que los parámetros 
dinámicos del manipulador aparezcan como funciones de la posición del manipulador 

1 Hemos usado las siguiente suposiciones para simplificar: M(0¿) = M(0), V(0¿. 0¡j) = V(0, 0), 
?(0¿) = G(0), y F(0 d ,@¿) = F(&,0). 
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FIGURA 10.7: Una implementación del sistema de control de manipulador basado en el 
modelo. 

solamente. Estas funciones podrían entonces calcularse mediante un proceso en segun¬ 
do plano o mediante una segunda computadora de control [8], o podrían buscarse en 
una tabla previamente calculada [12]. En esta arquitectura, los parámetros dinámicos 
pueden actualizarse a una velocidad menor que la del servo de lazo cerrado. Por ejem¬ 
plo, el cálculo en segundo plano podría llevarse a cabo a 60Hz, mientras que el servo 
de lazo cerrado estuviera funcionando a 250 Hz. 

Desconocimiento de los parámetros 

La segunda dificultad potencial que podemos encontrar al emplear el algoritmo de con¬ 
trol de momento de torsión calculado es que, por lo general, el modelo dinámico del 
manipulador no se conoce con precisión. Esto es especialmente cierto en algunos com¬ 
ponentes de la dinámica, como los efectos de la fricción. De hecho, es muy difícil cono¬ 
cer la estructura del modelo de fricción, por no hablar de los valores de los parámetros 
[13]. Por último, si el manipulador tiene cierta porción de su dinámica que no puede re¬ 
petirse (por ejemplo, porque cambie a medida que el robot se desgasta), es difícil tener 
buenos valores para los parámetros del modelo en todo momento. 

Por naturaleza, la mayoría de los robots estarán recogiendo varias piezas y herra¬ 
mientas. Cuando un robot sujeta una herramienta, la inercia y el peso de la misma cam¬ 
bian la dinámica del manipulador. En una situación industrial, las propiedades de la 
masa de las herramientas podrían conocerse; en este caso, pueden incluirse en la por¬ 
ción modelada de la ley de control. Al sujetar una herramienta, la matriz de inercia, la 
masa total y el centro de la masa del último vínculo del manipulador pueden actuali¬ 
zarse con nuevos valores que representan el efecto combinado del último vínculo más 
la herramienta. No obstante, en muchas aplicaciones las propiedades de las masas de 
los objetos que recoge el manipulador no se conocen, por lo que es difícil mantener un 
modelo dinámico preciso. 

La situación no ideal más simple posible es aquella en la que aún suponemos un mo¬ 
delo perfecto implementado en tiempo continuo, pero con un ruido externo que actúa pa¬ 
ra perturbar el sistema. En la figura 10.8 indicamos un vector de momentos de torsión de 
perturbación que actúan en las articulaciones. Al escribir la ecuación de error del sistema, 
incluyendo estas perturbaciones conocidas, llegamos a 

É + K v É + K p E = M~ 1 (&) r d 


( 10 . 20 ) 
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FIGURA 10.8: El controlador basado en el modelo con una perturbación externa en 
acción. 

en donde r d es el vector de momentos de torsión de perturbación en las articulaciones. 
El lado izquierdo de la ecuación (10.20) está desacoplado, pero del lado derecho pode¬ 
mos ver que una perturbación en cualquier articulación específica introducirá errores 
en las demás articulaciones, ya que M (©) no es, en general, diagonal. 

Con base en la ecuación (10.20) podrían realizarse algunos análisis simples; por 
ejemplo, es fácil calcular el error de servo de estado estable debido a una perturbación 
constante como 


E = (10.21) 

Cuando nuestro modelo del comportamiento dinámico de los manipuladores no 
es perfecto, el análisis del sistema de lazo cerrado resultante se hace más difícil. Defi¬ 
niremos la siguiente notación: M(Q) es nuestro modelo de la matriz de inercia del ma¬ 
nipulador, M(0). De igual forma, V (©, 0), G(0) y E(@, ©) son nuestros modelos de 
los términos de velocidad, de gravedad y de fricción del mecanismo actual respectiva¬ 
mente. Un conocimiento perfecto del modelo significaría que 

M(@) = M(0), 

V(0, 0) = V(0, 0), (10.22) 

G(0) = G(0), 

F(0, 0) = F(&, 0). 

Por lo tanto, y aunque la dinámica de manipuladores se da mediante 

r = M(©)0 + V(0, 0) + G(0) + F(0, 0), (10.23) 

nuestra ley de control calcula 

r = ar' + fí, 
oí — M(0), 

P = V(0, 0) + G(0) + F(0, 0). 


(10.24) 
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Por lo tanto, el desacoplamiento y la linealización no se realizarán perfectamente cuan¬ 
do los parámetros no se conozcan con exactitud. Si escribimos la ecuación de lazo ce¬ 
rrado para el sistema, tenemos que 

É + K V É + K p E 

= M~ l [(M - M)0 + (V — V) + (G — G) + (F - #)], (10.25) 

en donde los argumentos de las funciones dinámicas no se muestran por cuestión de 
brevedad. Observe que si el modelo fuera exacto, de manera que la ecuación (10.22) 
fuera cierta, entonces el lado derecho de la ecuación (10.25) sería cero y los errores des¬ 
aparecerían. Cuando los parámetros no se conocen con exactitud, la diferencia entre 
los parámetros actuales y los modelados producirá la excitación de los errores del ser¬ 
vo (lo que posiblemente produzca incluso un sistema inestable [21]) de acuerdo con la 
ecuación (10.25), que es algo complicada. 

Hablaremos sobre el análisis de estabilidad de un sistema de lazo cerrado no li¬ 
neal en la sección 10.7. 

10.6 SISTEMAS ACTUALES DE CONTROL DE ROBOTS INDUSTRIALES 

Debido a los problemas para tener un buen conocimiento de los parámetros, no está 
claro si tiene sentido tomarse la molestia de calcular una ley complicada de control ba¬ 
sada en el modelo para el control de manipuladores. El costo del poder de cómputo ne¬ 
cesario para calcular el modelo del manipulador a una velocidad suficiente podría no 
valer la pena, especialmente cuando la falta de conocimiento de los parámetros pudie¬ 
ra anular los beneficios de dicho método. Los fabricantes de robots industriales han de¬ 
cidido, probablemente por razones económicas, que no vale la pena tratar de usar un 
modelo de manipulador completo en el controlador. Por ahora los manipuladores ac¬ 
tuales se controlan mediante leyes de control muy simples que por lo general están 
completamente controladas por errores y se implementan en arquitecturas como las 
que estudiamos en la sección 9.10. En la figura 10.9 se muestra un robot industrial con 
un sistema servo de alto rendimiento. 

Control PID de una articulación 

La mayoría de los robots industriales actuales tienen un esquema de control que, en 
nuestra notación, estaría descrito por 

a = I, 

0 = 0, (10.26) 
en donde I es la matriz identidad de n x n. La porción del servo es 

r' = & d + K V É + K p E + K ¡ J Edt , (10.27) 

en donde K v , K p y K¡ son matrices diagonales constantes. En muchos casos, & d no está 
disponible y este término se hace simplemente cero. Esto es, la mayoría de los contro¬ 
ladores de robots no utilizan un componente basado en el modelo en ninguna parte de 
su ley de control. Este tipo de esquema de control PID es simple, ya que cada articula¬ 
ción se controla como un sistema de control separado. A menudo se utiliza un micro- 
procesador por cada articulación para implementar la ecuación (10.27), como se vio en 
la sección 9.10. 
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FIGURA 10.9: El Adept One, un robot de control directo fabricado por Adept Techno¬ 
logy, Inc. 

El rendimiento de un manipulador controlado de esta forma no es fácil de descri¬ 
bir. No se está realizando un desacoplamiento, por lo que el movimiento de cada articu¬ 
lación afecta a las demás articulaciones. Estas interacciones producen errores, los cuales 
son suprimidos por la ley de control manejada por errores. Es imposible seleccionar ga¬ 
nancias fijas que amortigüen críticamente la respuesta a las perturbaciones para todas 
las configuraciones. Por lo tanto se seleccionan ganancias “promedio” que aproximan 
el amortiguamiento crítico en el centro del espacio de trabajo del robot. En varias con¬ 
figuraciones extremas del brazo, el sistema se vuelve ya sea subamortiguado o sobrea¬ 
mortiguado. Dependiendo de los detalles del diseño mecánico del robot, estos efectos 
podrían ser relativamente pequeños, y el control sería bueno. En dichos sistemas es im¬ 
portante mantener las ganancias lo más altas posible para que las inevitables perturba¬ 
ciones se supriman rápidamente. 

Adición de compensación de gravedad 

Los términos de gravedad tienden a provocar errores de posicionamiento estático, por 
lo que algunos fabricantes de robots incluyen un modelo de gravedad G(0) en la ley 
de control [esto es, fí = G(@) en nuestra notación]. La ley de control completa toma 
la forma 


r' = <5L 


K..E 


K p E 


K ‘f 


Edt + G(0). 


( 10 . 28 ) 
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Dicha ley de control es tal vez el ejemplo más simple de un controlador basado 
en el modelo. Como la ecuación (10.28) ya no puede implementarse estrictamente de 
articulación en articulación, la arquitectura del controlador debe permitir la comunica¬ 
ción entre los controladores de las articulaciones o debe hacer uso de un procesador 
central, en vez de utilizar un procesador para cada articulación. 

Varias aproximaciones del control de desacoplamiento 

Existen varias formas de simplificar las ecuaciones dinámicas de un manipulador espe¬ 
cífico [3,14]. Después de la simplificación puede derivarse una ley de desacoplamiento y 
linealización aproximada. Una simplificación común podría ser descartar los compo¬ 
nentes del momento de torsión debidos a los términos de velocidad; esto es, modelar 
solamente los términos de inercia y de gravedad. A menudo los modelos de fricción no 
se incluyen en el controlador, ya que la fricción es muy difícil de modelar correctamen¬ 
te. Algunas veces la matriz de inercia se simplifica para tomar en cuenta el acoplamien¬ 
to mayor entre ejes, pero no para los efectos menores de acoplamiento cruzado. Por 
ejemplo, la referencia [14] presenta una versión simplificada de la matriz de masas del 
PUMA 560 que requiere sólo un 10% aproximadamente de los cálculos necesarios 
para calcular la matriz de masas completa, y aún así tiene una precisión dentro de un 
rango del 1%. 

10.7 ANÁLISIS DE ESTABILIDAD DE LYAPUNOV 

En el capítulo 9 examinamos los sistemas de control lineal en forma analítica para eva¬ 
luar la estabilidad y también el rendimiento de la respuesta dinámica en términos de 
amortiguamiento y ancho de banda de lazo cerrado. Los mismos análisis son válidos pa¬ 
ra un sistema no lineal que haya sido desacoplado y linealizado por medio de un contro¬ 
lador no lineal perfecto basado en el modelo, ya que el sistema resultante general es otra 
vez lineal. No obstante, cuando el controlador no realiza el desacoplamiento y la linea¬ 
lización o cuando son incompletos o imprecisos, el sistema de lazo cerrado general sigue 
siendo no lineal. Para los sistemas no lineales es mucho más difícil realizar el análisis de 
estabilidad y rendimiento. En esta sección presentaremos un método de análisis de es¬ 
tabilidad que se aplica tanto a sistemas lineales como a sistemas no lineales. 

Considere el sistema simple de masa-resorte con fricción que se presentó original¬ 
mente en el capítulo 9, cuya ecuación de movimiento es 


(10.29) 


mx + bx + kx = 0. 


La energía total del sistema se da mediante 



(10.30) 


en donde el primer término proporciona la energía cinética de la masa, y el segundo 
proporciona la energía potencial almacenada en el resorte. Observe que el valor v de 
energía del sistema siempre es no negativo (es decir, es positivo o cero). Vamos a en¬ 
contrar la tasa de cambio de la energía total al diferenciar la ecuación (10.30) respecto 
al tiempo, para obtener 


i) = mxx + kxx. 

Sustituyendo la ecuación (10.29) por mx en la ecuación (10.31) obtenemos 

v = —bx 2 , 


(10.31) 


(10.32) 
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la cual podemos ver que es siempre no positiva (porque b> 0). Por lo tanto, la energía siem¬ 
pre sale del sistema, a menos que x = 0. Esto implica que, sin importar la perturbación ini¬ 
cial, el sistema perderá energía hasta quedar inactivo. Investigando las posibles posiciones 
de reposo mediante un análisis de estado estable de la ecuación (10.29) obtenemos 

kx = 0, (10.33) 

o 

x = 0. (10.34) 

En consecuencia, por medio de un análisis de energía hemos demostrado que el siste¬ 
ma de la ecuación (10.29) con cualquier condición inicial (es decir, cualquier energía 
inicial) con el tiempo quedará inactivo en el punto de equilibrio. Esta prueba de esta¬ 
bilidad por medio de un análisis de energía es un simple ejemplo de una técnica más ge¬ 
neral conocida como análisis de estabilidad de Lyapunov, o método segundo (o directo) 
de Lyapunov, nombrado así en honor de un matemático ruso del siglo xix [15]. 

Una característica interesante de este método de análisis de estabilidad es que po¬ 
demos hacer conclusiones sobre la estabilidad sin despejar la solución de la ecuación 
diferencial que gobierna al sistema. No obstante, mientras que el método de Lyapunov 
es útil para examinar la estabilidad , generalmente no proporciona ninguna información 
sobre la respuesta transitoria o el rendimiento del sistema. Observe que nuestro análi¬ 
sis de energía no produjo información acerca de si el sistema estaba sobreamortiguado 
o subamortiguado, o sobre cuánto tiempo le llevaría suprimir una perturbación. Es im¬ 
portante distinguir entre estabilidad y rendimiento: un sistema estable podría no obs¬ 
tante exhibir un rendimiento de control insatisfactorio para su uso planeado. 

El método de Lyapunov es algo más general que nuestro ejemplo. Es una de las 
pocas técnicas que pueden aplicarse directamente a sistemas no lineales para investigar 
su estabilidad. Como medio para tener rápidamente una idea del método de Lyapunov 
(en suficiente detalle para nuestras necesidades), analizaremos una muy breve intro¬ 
ducción a la teoría y luego pasaremos directamente a varios ejemplos. Podrá encontrar 
un tratamiento más completo de la teoría de Lyapunov en las referencias [16] y [17]. 

El método de Lyapunov está enfocado en determinar la estabilidad de una ecua¬ 
ción diferencial 

X = f(X), (10.35) 

en donde Jesm x 1 y/(•) podría ser no lineal. Observe que las ecuaciones diferencia¬ 
les de mayor orden pueden escribirse siempre como un conjunto de ecuaciones de pri¬ 
mer orden en la forma de la ecuación (10.35). Para probar que un sistema es estable 
mediante el método de Lyapunov, es necesario proponer una función de energía gene¬ 
ralizada v(X), que tenga las siguientes propiedades: 

1. Que v(X) tenga primeras derivadas parciales continuas, y que v(X) > 0 para to¬ 
das las X excepto cuando u(0) = 0. 

2. Que i)(X) < 0. Aquí i)(X) representa el cambio en v(X) a lo largo de todas las tra¬ 
yectorias del sistema. 

Estas propiedades podrían ser válidas solamente en cierta región; o podrían ser 
globales, con sus correspondientes resultados de estabilidad más débiles o más fuertes. La 
idea intuitiva es que se demuestre que una función de estado positiva definida “tipo 
energía” siempre disminuye o permanece constante; por ende, el sistema es estable en 
el sentido en que el tamaño del vector de estado está acotado. 

Cuando ü(A) es estrictamente menor que cero, la convergencia asintótica del es¬ 
tado al vector cero puede concluirse. El trabajo original de Lyapunov se extendió de 
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una manera importante gracias a LaSalle y Lefschetz [4], quienes demostraron que en 
ciertas situaciones, aun cuando ú( X) < 0 (observe la igualdad incluida), puede demos¬ 
trarse la estabilidad asintótica. Para nuestros fines podemos tratar con el caso en que 
i) (X) — 0 realizando un análisis de estado estable para saber si la estabilidad es asintó¬ 
tica o si el sistema que se está estudiando puede “atorarse” en algún lugar además de 
v(X) = 0. 

Se dice que un sistema como el descrito por la ecuación (10.35) es autónomo, ya 
que la función/(■) no es explícita del tiempo. El método de Lyapunov se extiende tam¬ 
bién a los sistemas no autónomos, en los que el tiempo es un argumento de la función 
no lineal. Vea las referencias [4,17] para más detalles. 


EJEMPLO 10.4 

Considere el sistema lineal 

X = -AX, (10.36) 

en donde A es de m x m y es positiva definida. Proponga la función candidata de 
Lyapunov 

v(X) = \x T X, (10.37) 

que es continua y no negativa en todas partes. La diferenciación produce 


v(X) = X T X 

= X t (-AX) (10.38) 

= -x t ax, 

que en todas partes es no positiva, ya que A es una matriz positiva definida. Por ende, 
la ecuación (10.37) es evidentemente una función de Lyapunov para el sistema de la 
ecuación (10.36). El sistema es asintóticamente estable, ya que i)(X) puede ser cero só¬ 
lo cuando X = 0; en cualquier otra parte, X debe disminuir. 


EJEMPLO 10.5 

Considere un sistema mecánico de resorte-amortiguador en el que tanto el resorte co¬ 
mo el amortiguador son no lineales: 

x + b(x) + k(x) = 0. (10.39) 

Las funciones b(-) y kíj son funciones continuas del primer y tercer cuadrantes, de tal 
forma que 

xb(x) > 0 / o / 0, 

xk{x) > 0 / o r / 0. (10.40) 

Una vez propuesta la función de Lyapunov 

1 í x 

v(x,x) = -x * 1 2 + I k(X)dX, (10.41) 

2 Jo 
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v(x, i) = xx + k(x)x, 

= —xb(x) — k{x)x + k(x)x, (10.42) 

= —xb(x). 

Aquí, ü(-) es no positiva pero sólo está semidefinida, ya que no es una función de x si¬ 
no sólo de x. Para poder concluir una estabilidad asintótica, tenemos que asegurarnos 
que no es posible que el sistema se “atore” con una x distinta de cero. Para estudiar to¬ 
das las trayectorias para las cuales x — 0, debemos considerar que 

x = —k(x), (10.43) 

en donde x = 0 es la única solución. Por ende, el sistema quedará inactivo sólo si x = x 
— x — 0. 


EJEMPLO 10.6 

Considere un manipulador con una dinámica dada por 

r = M(©)0 + P(0, 0) + G(©) (10.44) 

y controlado con la ley de control 

r = K p E - K d ® + G(®), (10.45) 

en donde K y K d son matrices de ganancia diagonales. Observe que este controlador 
no obliga al manipulador a seguir una trayectoria, sino que mueve el manipulador has¬ 
ta un punto de destino sobre una ruta especificada por la dinámica del manipulador, y 
después regula la posición ahí. El sistema de lazo cerrado resultante, que se obtiene al 
igualar las ecuaciones (10.44) y (10.45), es 

M(©)0 + V(0, 0) + K d @ + K p & = K p ® d ; (10.46) 

y se puede probar que es estable asintóticamente de manera global mediante el méto¬ 
do de Lyapunov [18,19]. 

Considere la siguiente función candidata de Lyapunov: 

v = ^E T K p E. (10.47) 

La función (10.47) es siempre positiva o cero, ya que la matriz de masas del manipula¬ 
dor, representada por M(0), y la matriz de ganancia de posición, K , son matrices po¬ 
sitivas definidas. Al diferenciar la ecuación (10.46) se produce la siguiente ecuación: 

\ 

v = + 9 t M( 9)@ - E T K p ® 

\ 

= -0 r M(©)@ - ® r K d © - ® T V(@, 0) 

= - @ T K d é , 


(10.48) 
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la cual será no positiva siempre y cuando K d sea positiva definida. Para realizar el últi¬ 
mo paso en la ecuación (10.48) hemos utilizado la interesante identidad 

-0 r M(©)0 = & T V(@, ©), (10.49) 

que puede demostrarse mediante la investigación de la estructura de las ecuaciones de 
movimiento de Lagrange [18-20]. (Vea también el ejercicio 6.17). 

A continuación investigaremos si el sistema puede “atorarse” con un error distin¬ 
to de cero. Como v puede ser cero sólo a lo largo de trayectorias en las que © = 0 y 
0 = 0, podemos ver de la ecuación (10.46) que, en este caso, 

K p E = 0, (10.50) 

y como K p es no singular, tenemos que 

E = 0. (10.51) 

Por lo tanto, la ley de control (10.45) aplicada al sistema (10.44) logra una estabilidad 
asintótica global. 

Esta prueba es importante, ya que explica, hasta cierto punto, por qué funcionan 
los robots industriales de la actualidad, la mayoría de los cuales usa un servo simple 
controlado por errores, ocasionalmente con modelos de gravedad, y que por lo tanto 
son bastante similares a la ecuación (10.45). 


Vea los ejercicios 10.11 a 10.16 para más ejemplos de leyes de control de manipu¬ 
ladores no lineales que puedan probarse estables por el método de Lyapunov. Recien¬ 
temente, la teoría de Lyapunov ha aparecido cada vez más en las publicaciones de 
investigación de robótica [18-25]. 

10.8 SISTEMAS DE CONTROL DE BASE CARTESIANA 

En esta sección presentaremos la noción de control de base cartesiana. Aunque estos 
métodos no se utilizan actualmente en los robots industriales, hay actividad en varias 
instituciones de investigación sobre dichos temas. 

Comparación con los esquemas basados en articulaciones 

En todos los esquemas de control para los manipuladores que hemos descrito hasta 
ahora, hemos supuesto que la trayectoria deseada estaba disponible en términos de his¬ 
toriales de tiempo de la posición, la velocidad y la aceleración de las articulaciones. Da¬ 
do que estas entradas deseadas estaban disponibles, diseñamos esquemas de control 
basado en articulaciones; esto es, esquemas en los que evaluamos errores en la trayec¬ 
toria al encontrar la diferencia entre las cantidades deseada y real, expresadas en el es¬ 
pacio de articulación. Muy a menudo deseamos que el efector final del manipulador 
siga líneas rectas u otras formas de ruta descritas en coordenadas cartesianas. Como vi¬ 
mos en el capítulo 7, es posible calcular los historiales de tiempo de la trayectoria de es¬ 
pacio de articulación que corresponda a las rutas de línea recta cartesianas. La figura 
10.10 muestra este método para el control de trayectorias de manipuladores. Una ca¬ 
racterística básica del método es el proceso de conversión de trayectorias, el cual se uti¬ 
liza para calcular las trayectorias de las articulaciones, lo cual va seguido por algún tipo 
de esquema de servo basado en la articulación, como el que hemos estado estudiando. 
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X d 

X d 

X d 



FIGURA 10.10: Un esquema de control basado en articulación, con entrada de ruta car¬ 
tesiana. 


El proceso de conversión de trayectorias es considerablemente difícil (en térmi¬ 
nos de costo computacional) si se va a realizar en forma analítica. Los cálculos que se 
requieren para ello son 

@ d = CININV(Xd), 

® d = J~\®)x d , (10.52) 

® d = + J~ l {®YU 

En la medida en que dicho cálculo se realice en los sistemas actuales, generalmente só¬ 
lo se lleva a cabo la solución para © d usando la cinemática inversa, y luego se calculan 
las velocidades y las aceleraciones de las articulaciones numéricamente mediante la pri¬ 
mera y la segunda diferencias. No obstante, dicha diferenciación numérica tiende a am¬ 
plificar el ruido e introduce un retraso, a menos que pueda realizarse con un filtro no 
causal. 2 Por lo tanto, estamos interesados en encontrar una manera menos costosa en 
términos computacionales de calcular la ecuación (10.52), o de sugerir un esquema de 
control en el que esta información no sea necesaria. 

Un método alternativo se muestra en la figura 10.11. Aquí la posición detectada del 
manipulador se transforma inmediatamente por medio de las ecuaciones cinemáticas, en 
una descripción cartesiana de posición. Esta descripción se compara entonces con la posi¬ 
ción cartesiana deseada para poder formar errores en espacio cartesiano. Los esquemas 
de control basados en la formación de errores en espacio cartesiano se conocen como es¬ 
quemas de control de base cartesiana. Por simplicidad, en la figura 10.11 no se muestra la 
retroalimentación de la velocidad, pero estaría presente en cualquier implementación. 

El proceso de conversión de trayectorias se sustituye por cierto tipo de conver¬ 
sión de coordenadas dentro del lazo del servo. Observe que los controladores de base 
cartesiana deben realizar muchos cálculos en el lazo; la cinemática y otras transforma¬ 
ciones se encuentran ahora “dentro del lazo”. Esto puede representar una desventaja 
de los métodos de base cartesiana; el sistema resultante podría operar a una frecuencia 



FIGURA 10.11: El concepto de un esquema de control de base cartesiana. 


2 La diferenciación numérica introduce un retraso a menos que pueda basarse en valores pasados, pre¬ 
sentes y futuros. Cuando se planea previamente toda la ruta completa, puede hacerse este tipo de diferen¬ 
ciación numérica no causal. 
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de muestreo menor, en comparación con los sistemas basados en articulaciones (dada 
la misma capacidad de computadora), lo que degradaría en general la estabilidad y las 
capacidades del sistema para eliminar perturbaciones. 

Esquemas intuitivos de control cartesiano 

La figura 10.12 muestra un posible esquema de control que viene a la mente de manera 
algo intuitiva. Aquí la posición cartesiana se compara con la posición deseada para for¬ 
mar un error, representado por áX, en espacio cartesiano. Este error, que puede conside¬ 
rarse pequeño si el sistema de control está haciendo su trabajo, puede asignarse a un 
pequeño desplazamiento en espacio de articulación mediante el jacobiano inverso. Los 
errores resultantes en espacio de articulación, representados por 86, se multiplican enton¬ 
ces por las ganancias para calcular momentos de torsión que tiendan a reducir estos errores. 
Observe que la figura 10.12 muestra un controlador simplificado en el que, por claridad, no 
se ha mostrado la retroalimentación de velocidad, y que podría agregarse de una mane¬ 
ra simple. Llamaremos a este esquema el controlador de jacobiano inverso. 

La figura 10.13 muestra otro esquema que podría venir a la mente. Aquí el vector 
de error cartesiano se multiplica por una ganancia para calcular un vector de fuerza car¬ 
tesiano. Esto puede pensarse como una fuerza cartesiana que, si se aplica al efector final 
del robot, empujaría al efector final en una dirección que tendería a reducir el error car¬ 
tesiano. Este vector de fuerza cartesiana (que en realidad es un vector de fuerza-momen¬ 
to) se asigna entonces a través de la transpuesta del jacobiano para poder calcular los 
momentos de torsión de articulación equivalentes que tiendan a reducir los errores ob¬ 
servados. A este esquema lo llamaremos controlador de jacobiano transpuesto. 

Hemos llegado al controlador de jacobiano inverso y al controlador de jacobiano 
transpuesto de forma intuitiva. No podemos estar seguros de que dichos arreglos sean 
estables, mucho menos que tengan un buen rendimiento. Además, es curioso que los es¬ 
quemas sean en extremo similares, excepto que uno contiene la inversa del jacobiano y 
el otro su transpuesta. Recuerde que la inversa no es igual a la transpuesta en general 
(sólo en el caso de un manipulador estrictamente cartesiano se aplica que J T — Z” 1 ). El 
rendimiento dinámico exacto de dichos sistemas (si se expresan en una ecuación de es¬ 
pacio de error de segundo orden, por ejemplo) es muy complicado; aunque resulta que 



FIGURA 10.12: El esquema de control cartesiano de jacobiano inverso. 



FIGURA 10.13: El esquema de control cartesiano de jacobiano transpuesto. 
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ambos esquemas funcionarán (es decir, pueden hacerse estables), pero no bien (es de¬ 
cir, el rendimiento no es bueno sobre todo el espacio de trabajo). Ambos pueden ha¬ 
cerse estables mediante la selección apropiada de ganancias, incluyendo cierta forma 
de retroalimentación de velocidad (la cual no se mostró en las figuras 10.12 y 10.13). 
Aunque ambos funcionan, ninguno es correcto en el sentido de que no podemos selec¬ 
cionar ganancias fijas que produzcan polos de lazo cerrado fijos. La respuesta dinámi¬ 
ca de dichos controladores variará con la configuración del brazo. 

Esquema de desacoplamiento cartesiano 

Para los controladores de base cartesiana tales como los basados en articulación, el 
buen rendimiento estaría caracterizado por una dinámica de error constante sobre to¬ 
das las configuraciones del manipulador. Los errores se expresan en espacio cartesiano 
en esquemas de base cartesiana, lo que significa que sería conveniente diseñar un sis¬ 
tema que suprimiera los errores cartesianos de una manera críticamente amortiguada 
en todas las configuraciones posibles. 

Así como logramos un buen control con un controlador basado en articulación 
que estaba basado en un modelo de linealización y desacoplamiento del brazo, también 
podemos hacer lo mismo para el caso cartesiano. No obstante, ahora debemos escribir 
las ecuaciones dinámicas de movimiento del manipulador en términos de variables car¬ 
tesianas, como vimos en el capítulo 6. La forma resultante de las ecuaciones de movi¬ 
miento es bastante análoga a la versión en espacio de articulación. La dinámica de 
cuerpo rígido puede escribirse así: 


(10.53) 


T = M v (0)x + V x (®, 0) + G x (&), 


en donde T es un vector ficticio de fuerza-momento que actúa sobre el efector final del ro¬ 
bot, y x es un vector cartesiano apropiado que representa la posición y orientación del efec¬ 
tor final [8]. Análoga a las cantidades en espacio de articulación, M x (Q) es la matriz de 
masas en espacio cartesiano, V (0, 0) es un vector con términos de velocidad en espacio 
cartesiano y G x (&) es un vector con términos de gravedad en el espacio cartesiano. 

Al igual que como hicimos en el caso basado en articulación, podemos usar las 
ecuaciones dinámicas en un controlador de desacoplamiento y linealización. Así como 
la ecuación (10.53) calcula T, un vector de fuerza cartesiana ficticio que debe aplicar¬ 
se a la mano, también tendremos que usar la transpuesta del jacobiano para poder im- 
plementar el control; esto es, una vez que se calcula T mediante la ecuación (10.53) 
no podemos hacer que se aplique una fuerza cartesiana al efector final; en vez de ello 
calculamos los momentos de torsión de articulación requeridos para balancear efecti¬ 
vamente el sistema si fuéramos a aplicar esta fuerza: 


r = J t (@)T. 


(10.54) 


La figura 10.14 muestra un sistema de control de brazo cartesiano que utiliza un 
desacoplamiento dinámico completo. Observe que el brazo va precedido por la trans¬ 
puesta del jacobiano. Tome en cuenta que el controlador de la figura 10.14 permite des¬ 
cribir rutas cartesianas directamente, sin necesidad de conversión de trayectorias. 

Al igual que en el caso del espacio de articulación, podría lograrse mejor una im- 
plementación práctica a través del uso de un sistema de control de velocidad dual. La 
figura 10.15 muestra un diagrama de bloques de un controlador de desacoplamiento y 
linealización de base cartesiana, en el que los parámetros dinámicos se escriben como 
funciones de la posición del manipulador solamente. Estos parámetros dinámicos se 
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FIGURA 10.14: Esquema de control basado en un modelo cartesiano. 



FIGURA 10.15: Una implementación del esquema de control basado en un modelo carte¬ 
siano. 


actualizan a una velocidad menor que la velocidad del servo, mediante un proceso en 
segundo plano o una segunda computadora de control, lo cual es apropiado, ya que de¬ 
seamos un servo veloz (que funcione tal vez a 500 Hz o aún más) para maximizar el re¬ 
chazo de perturbaciones y la estabilidad. Los parámetros dinámicos son sólo funciones 
de la posición del manipulador, por lo que necesitan actualizarse a una proporción que 
se relaciona sólo con la rapidez con la que el manipulador cambia de configuración. 
La velocidad de actualización de parámetros probablemente no necesita ser mayor de 
100 Hz [8]. 

10.9 CONTROL ADAPTATIVO 

Al hablar sobre el control basado en el modelo se recalcó que, a menudo, los paráme¬ 
tros del manipulador no se conocen con exactitud. Cuando los parámetros en el modelo 
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FIGURA 10.16: El concepto de un controlador de manipulador adaptativo. 


no concuerdan con los parámetros del dispositivo real se producen errores de servo, co¬ 
mo se hace explícito en la ecuación (10.25). Estos errores de servo podrían usarse para 
controlar cierto esquema de adaptación que intente actualizar los valores de los pará¬ 
metros del modelo hasta que los errores desaparezcan. Se han propuesto varios esque¬ 
mas adaptativos de ese tipo. 

Un esquema ideal adaptativo podría ser como el de la figura 10.16, donde usamos 
una ley de control basada en el modelo, como se desarrolló en este capítulo. Hay un 
proceso de adaptación que, dadas las observaciones del estado del manipulador y los 
errores de servo, reajusta los parámetros en el modelo no lineal hasta que desaparezcan 
los errores. Un sistema de ese tipo aprendería sus propias propiedades dinámicas. El di¬ 
seño y el análisis de los esquemas adaptativos es un tema que está más allá del alcance 
de este libro. Un método que posee la misma estructura que se muestra en la figura 10.16, 
y que se ha probado que es globalmente estable, se presenta en las referencias [20] y 
[21]. La referencia [22] utiliza una técnica relacionada. 
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EJERCICIOS 

10.1 [15] Encuentre las ecuaciones de control no lineales para un controlador a, f> particio- 
nado para el sistema 

r = (2.V6 + 1)6 + 3 9 2 - sen (6). 

Seleccione las ganancias de forma que este sistema siempre esté críticamente amorti¬ 
guado con k CL = 10. 


314 Capítulo 10 Control no lineal de los manipuladores 

10.2 [15] Encuentre las ecuaciones de control no lineales para un controlador a, /i particio- 
nado para el sistema 

r = 596 + 26 - 13Ó 3 + 5. 

Seleccione las ganancias de forma que este sistema siempre esté críticamente amorti¬ 
guado con k CL = 10. 

10.3 [19] Dibuje un diagrama de bloque que muestre un controlador en espacio de articu¬ 
lación para el brazo de dos vínculos de la sección 6.7, de tal forma que el brazo esté 
críticamente amortiguado sobre todo su espacio de trabajo. Muestre las ecuaciones 
dentro de los bloques de un diagrama de bloques. 

10.4 [20] Dibuje un diagrama de bloques que muestre un controlador en espacio cartesia¬ 
no para el brazo de dos vínculos de la sección 6.7, de tal forma que el brazo esté crí¬ 
ticamente amortiguado sobre todo su espacio de trabajo (vea el ejemplo 6.6). Muestre 
las ecuaciones dentro de los bloques de un diagrama de bloques. 

10.5 [18] Diseñe un sistema de control de seguimiento de trayectorias para el sistema cuya 
dinámica se da mediante las ecuaciones 

r l = m l l 1#1 + m íh l 2^2’ 

r 2 = í » 2 / 2^1 + %) + v 2 ^ 2 - 

¿Cree usted que estas ecuaciones podrían representar un sistema real? 

10.6 [17] Para el sistema de control diseñado para el manipulador de un vínculo del ejem¬ 
plo 10.3, encuentre una expresión para el error de posición de estado estable como 
una función del error en el parámetro de la masa. Haga que i'm = m — m. El resul¬ 
tado deberá ser una función de /, g, 6, V'm, m y k p . ¿Para qué posición del manipula¬ 
dor se obtiene un máximo? 

10.7 [26] Para el sistema mecánico de dos grados de libertad de la figura 10.17, diseñe un 
controlador que pueda hacer que x 1 y x 2 sigan las trayectorias y supriman las pertur¬ 
baciones en una forma críticamente amortiguada. 

10.8 [30] Considere las ecuaciones dinámicas del manipulador de dos vínculos de la sección 
6.7, en forma de espacio de configuración. Derive expresiones para la sensibilidad del 
valor de momento de torsión calculado respecto a pequeñas desviaciones en 0. ¿Pue¬ 
de decir algo sobre qué tan frecuentemente debe recalcularse el comportamiento di¬ 
námico en un controlador como el de la figura 10.7, como una función de las 
velocidades de articulación promedio esperadas durante las operaciones normales? 



FIGURA 10.17: Sistema mecánico con dos grados de libertad. 
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10.9 [32] Considere las ecuaciones dinámicas del manipulador de dos vínculos del ejemplo 
6.6 en forma de espacio de configuración cartesiano. Derive expresiones para la sensi¬ 
bilidad del valor de momento de torsión calculado respecto a pequeñas desviaciones en 
0. ¿Puede decir algo sobre qué tan frecuentemente debe recalcularse el compor¬ 
tamiento dinámico en un controlador como el de la figura 10.15, como una función de 
las velocidades de articulación promedio esperadas durante las operaciones normales? 

10.10 [15] Diseñe un sistema de control para el sistema 

/ = 5xx + 2x — 12. 

Seleccione las ganancias de manera que este sistema siempre esté críticamente amor¬ 
tiguado, con una rigidez de lazo cerrado de 20. 

10.11 [20] Considere un sistema de regulación de posición que (sin perder la generalidad) 
intente mantener © d = 0. Demuestre que la ley de control 

r = -K p ® - M(@)K V ® + G(0) 

produce un sistema no lineal asintóticamente estable. Debe tomar K y para que sea 
de la forma K v = k y I n , en donde k v es un escalar e 1 n es la matriz identidad de n x n. 
Sugerencia: Esto es similar al ejemplo 10.6. 

10.12 [20] Considere un sistema de regulación de posición que (sin perder la generalidad) 
intente mantener © d = 0. Demuestre que la ley de control 

r = -K p ® - M{®)K V ® + G(0) 

produce un sistema no lineal asintóticamente estable. Debe tomar K v para que sea de 
la forma K = kj n , en donde k es un escalar e I n es la matriz identidad den x n. La 
matriz M(0) es una estimación positiva definida de la matriz de masas del manipulador. 
Sugerencia: Esto es similar al ejemplo 10.6. 

10.13 [25] Considere un sistema de regulación de posición que (sin perder la generalidad) 
intente mantener ® d = 0. Demuestre que la ley de control 

r = —M(®)[K p © + K v ® ] + G(0) 

produce un sistema no lineal asintóticamente estable. Debe tomar K para que sea 
de la forma K v = kj n , en donde k es un escalar e l n es la matriz identidad de n x n. 
Sugerencia: Esto es similar al ejemplo 10.6. 

10.14 [25] Considere un sistema de regulación de posición que (sin perder la generalidad) 
intente mantener ® d = 0. Demuestre que la ley de control 

r = —M(@)[K p ® + K v @] + G(0) 

produce un sistema no lineal asintóticamente estable. Debe tomar K v para que sea de 
la forma K v = k y I n , en donde k y es un escalar e I n es la matriz de identidad n x n. La 
matriz M(Q) es una estimación positiva definida de la matriz de masas del manipulador. 
Sugerencia: Esto es similar al ejemplo 10.6. 

10.15 [28] Considere un sistema de regulación de posición que (sin perder la generalidad) 
intente mantener © d = 0. Demuestre que la ley de control 

r = -K p ® - K v ® 

produce un sistema no lineal estable. Demuestre que la estabilidad no es asintótica 
y dé una expresión para el error de estado estable. Sugerencia: Esto es similar al 
ejemplo 10.6. 
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10.16 [30] Demuestre la estabilidad global del controlador cartesiano de jacobiano trans¬ 
puesto que se presentó en la sección 10.8. Use una forma apropiada de retroalimen- 
tación de velocidad para estabilizar el sistema. 

Sugerencia: Vea la referencia [18]. 

10.17 [15] Diseñe un controlador de seguimiento de trayectorias para un sistema con una 
dinámica dada por 


/ = ax 2 xx + bx 2 + csen(.r), 


de tal forma que los errores se supriman en forma críticamente amortiguada sobre 
todas las configuraciones. 

10.18 [15] Un sistema con una dinámica de lazo abierto dada por 


r = m'é + hO* + cÓ 


se controla mediante la ley de control 


m[6 d + k v é + k p e] + sen (9). 


Encuentre la ecuación diferencial que caracterice la acción de lazo cerrado del sistema. 


EJERCICIO DE PROGRAMACIÓN (PARTE 10) 

Repita el ejercicio de programación de la parte 9 y utilice las mismas pruebas, pero con un 
nuevo controlador que utilice un modelo dinámico completo de los 3 vínculos para desaco¬ 
plar y linealizar el sistema. Para este caso, utilice 


K 


p 


100.0 0.0 0.0 

0.0 100.0 0.0 

0.0 0.0 100.0 


Seleccione una K v diagonal que garantice un amortiguamiento crítico sobre todas las confi¬ 
guraciones del brazo. Compare los resultados con los que se obtuvieron con el controlador 
más simple utilizado en el ejercicio de programación, parte 9. 
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11.7 ESQUEMAS DE CONTROL DE ROBOTS INDUSTRIALES EN LA ACTUALIDAD 


11.1 INTRODUCCIÓN 

El control de la posición es apropiado cuando un manipulador está siguiendo una tra¬ 
yectoria por el espacio, pero cuando se hace cualquier tipo de contacto entre el efector 
final y el ambiente del manipulador, el simple control de la posición no es suficiente. 
Considere un manipulador que lava una ventana con una esponja. La elasticidad de la 
esponja podría hacer posible la regulación de la fuerza que se aplica a la ventana, me¬ 
diante el control de la posición del efector final con relación al vidrio. Si la esponja es 
muy elástica o si la posición del vidrio se conoce con mucha precisión, esta técnica po¬ 
dría funcionar bastante bien. 

No obstante, si la rigidez del efector final, de la herramienta o del entorno es al¬ 
ta, se vuelve muy difícil realizar operaciones en las que el manipulador ejerza presión 
contra una superficie. En vez de lavar con una esponja, imagine que el manipulador está 
raspando pintura de una superficie de vidrio usando una herramienta de raspado rígi¬ 
da. Si hay incertidumbre respecto a la posición de la superficie del vidrio, o si exis¬ 
te algún error en la posición del manipulador, esta tarea se volvería imposible. O se 
rompería el vidrio, o el manipulador agitaría la herramienta de raspado sobre el vidrio 
sin que hubiera ningún tipo de contacto. 

En las tareas de lavado y de raspado sería más razonable no especificar la posi¬ 
ción del plano del vidrio, sino especificar lina fuerza que se va a mantener normal a la 
superficie. 

En este capítulo, más que en los anteriores, presentaremos métodos que aún no 
son empleados por robots industriales, excepto de una manera extremadamente sim¬ 
plificada. El concepto más importante del capítulo es introducir el controlador híbrido 
de posición/fuerza, el cual es un formalismo mediante el cual los robots industriales 
podrían controlarse algún día para realizar tareas que requieran del control de la fuer¬ 
za. No obstante, sin importar cuál o cuáles métodos emerjan como prácticos para la 
aplicación industrial, muchos de los conceptos presentados en este capítulo seguirán 
siendo ciertamente válidos. 
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11.2 APLICACIÓN DE ROBOTS INDUSTRIALES A TAREAS DE ENSAMBLAJE 

La mayoría de los robots industriales se emplea en aplicaciones simples (relativamen¬ 
te hablando), tales como soldadura por puntos pintura con pistola de aire y operacio¬ 
nes de levantamiento y colocación. El control de la fuerza ya ha aparecido en algunas 
aplicaciones; por ejemplo, algunos robots ya cuentan con un control de fuerza simple 
que les permite realizar tareas tales como triturado y eliminación de rebabas. Aparen¬ 
temente la siguiente área de aplicación será en las tareas de líneas de ensamblaje en las 
que se unen una o más piezas. En dichas tareas de unión de piezas es extremadamente 
importante el monitoreo y el control de las fuerzas de contacto. 

El control preciso de los manipuladores para enfrentar incertidumbres y variaciones 
en sus entornos de trabajo es el prerrequisito para la aplicación de manipuladores de ro¬ 
bots en las operaciones de ensamblaje en la industria. Al parecer, si se colocan sensores en 
las manos de un manipulador para que proporcionen información sobre el estado de las 
tareas que realizan, habría un gran avance hacia el uso de robots para las tareas de ensam¬ 
blaje. Actualmente la destreza de los manipuladores sigue siendo considerablemente ba¬ 
ja y continúa limitando su aplicación en el área de ensamblaje automatizado. 

Para utilizar manipuladores en tareas de ensamblaje se requiere que la precisión 
con la que las piezas se colocan, una respecto a la otra, sea bastante alta. En general, 
los robots industríales actuales no son lo suficiente precisos para estas tareas, y podría no 
tener sentido construir robots que pudieran serlo. Pueden construirse manipuladores 
de una mayor precisión pero a expensas del tamaño, peso y costo. Sin embargo, la ha¬ 
bilidad de medir y controlar las fuerzas de contacto generadas en la mano ofrece una 
posible alternativa para extender la precisión efectiva de una manipulación. Como se 
utilizan mediciones relativas, los errores absolutos en la posición del manipulador y en 
los objetos manipulados no son tan importantes como lo serían en un sistema contro¬ 
lado solamente por la posición. Las pequeñas variaciones en la posición relativa gene¬ 
ran grandes fuerzas de contacto cuando interactúan piezas de rigidez moderada, por lo 
que el conocimiento y el control de estas fuerzas puede producir un tremendo incre¬ 
mento en la precisión posicional efectiva. 

11.3 UN PARADIGMA DE CONTROL EN TAREAS PARCIALMENTE RESTRINGIDAS 

El método presentado en este capítulo se basa en un marco de trabajo para el control 
en situaciones en las que el movimiento del manipulador está parcialmente restringido 
por el contacto con una o más superficies [1-3]. Este marco de trabajo para entender 
las tareas parcialmente restringidas se basa en un modelo simplificado de interacción 
entre el efector final del manipulador y el entorno: nos interesa describir el contacto y 
las libertades, por lo que sólo consideramos las fuerzas debido al contacto. Esto es equi¬ 
valente a realizar un análisis casi estático e ignorar otras fuerzas estáticas, como ciertos 
componentes de fricción y de gravedad. El análisis es razonable cuando las fuerzas de¬ 
bidas al contacto entre objetos relativamente rígidos son la fuente dominante de fuer¬ 
zas que actúan en el sistema. Observe que la metodología que se presenta aquí es algo 
simplista y tiene ciertas limitaciones, pero es una buena forma de introducir los concep¬ 
tos básicos implicados y lo hace a un nivel apropiado para este texto. Para una meto¬ 
dología relacionada pero más general y rigurosa, vea la referencia [19]. 

Toda tarea de manipulación puede descomponerse en subtareas que se definen 
mediante una situación de contacto específica que ocurre entre el efector final del ma¬ 
nipulador (o herramienta) y el entorno de trabajo. Con cada subtarea podemos asociar 
un conjunto de restricciones, llamadas restricciones naturales, que se producen debido 
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a las características mecánicas y geométricas específicas de la configuración de la tarea. 
Por ejemplo, una mano en contacto con una superficie estacionaria y rígida no está li¬ 
bre para moverse a través de esa superficie; por ende, existe una restricción de posición 
natural. Si la superficie no tiene fricción, la mano no está libre para aplicar fuerzas ar¬ 
bitrarias tangentes a la superficie; por ende, existe una restricción de fuerza natural. 

En nuestro modelo de contacto con el entorno, para la configuración de cada sub¬ 
tarea puede definirse una superficie generalizada con restricciones de posición a lo lar¬ 
go de las normales para esta superficie, y restricciones de fuerza a lo largo de las 
tangentes. Estos dos tipos de restricción (fuerza y posición) particionan los grados de 
libertad de los posibles movimientos del efector final en dos conjuntos ortogonales que 
deben controlarse de acuerdo con varios criterios. Observe que este modelo de contac¬ 
to no incluye todas las posibles situaciones de contacto. (Vea la referencia [19] para un 
esquema más general). 

La figura 11.1 muestra dos tareas representativas junto con sus restricciones na¬ 
turales asociadas. Observe que, en cada caso, la tarea se describe en términos de una 
trama ¡C¡, la llamada trama de restricción, que se posiciona en una ubicación relevante 
para la tarea. De acuerdo con la tarea, [C¡ podría estar fija en el entorno o podría mo¬ 
verse con el efector final del manipulador. En la figura ll.l(a), la trama de restricción 
está unida a la manivela como se muestra y se mueve junto con ella, con la dirección X 
indicando siempre hacia el punto pivote de la manivela. La fricción que actúa en la pun¬ 
ta de los dedos asegura una sujeción firme sobre el mango, el cual está sobre un eje de 
manera que pueda girar con respecto al brazo manivela. En la figura ll.l(b) la trama 
de restricción está unida a la punta del destornillador y se mueve con él a medida que 
se desarrolla la tarea. Observe que en la dirección Y la fuerza se restringe para ser ce¬ 
ro, ya que la ranura del tornillo permitiría al destornillador deslizarse en esa dirección. 
En estos ejemplos se sigue cumpliendo un conjunto dado de restricciones durante toda 
la tarea. En situaciones más complejas, la tarea se descompone en subtareas para las 
que pueda identificarse un conjunto constante de restricciones naturales. 



(a) Giro de la manivela 



(b) Giro del destornillador 

FIGURA 11.1: Las restricciones naturales para dos tareas distintas. 
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En la figura 11.1 se han indicado las restricciones de posición dando valores para 
los componentes de velocidad del efector final V, descrito en la trama {C¡. Podríamos 
haber indicado las restricciones de posición dando expresiones para la posición en vez 
de velocidades; no obstante, en muchos casos es más simple especificar una restricción de 
posición como una restricción de “velocidad igual a cero”. De igual forma se han espe¬ 
cificado las restricciones de fuerza dando valores para los componentes del vector de 
fuerza-momento T, que actúa sobre el efector final descrito en la trama |C¡. Observe que 
cuando decimos restricciones de posición indicamos restricciones de posición o de orien¬ 
tación, y cuando decimos restricciones de fuerza indicamos restricciones de fuerza o de 
momento. El término restricciones naturales se utiliza para indicar que estas restriccio¬ 
nes surgen naturalmente de la situación de contacto específica. No tienen nada que ver 
con el movimiento deseado o esperado del manipulador. 

Las restricciones adicionales, llamadas restricciones artificiales, se introducen de 
acuerdo con las restricciones naturales para especificar movimientos deseados o la apli¬ 
cación de fuerza. Esto es, cada vez que el usuario especifica una trayectoria deseada, ya 
sea en posición o en fuerza, se define una restricción artificial. Estas restricciones tam¬ 
bién ocurren a lo largo de las tangentes y las normales de la superficie de restricción ge¬ 
neralizada pero, a diferencia de las restricciones naturales, las restricciones de fuerza 
artificiales se especifican a lo largo de las normales de la superficie, y las restricciones 
de posición artificiales se especifican a lo largo de las tangentes; por ende, se preserva 
la consistencia con las restricciones naturales. 

La figura 11.2 muestra las restricciones naturales y artificiales para dos tareas. 
Observe que cuando se da una restricción de posición natural para un cierto grado de 


(a) Giro de la manivela 



(b) Giro del destornillador 



Restricciones naturales 


V x = o 

O 

II 

u z = 0 

n z = 0 

(ri x — 0 


1»V = 0 


Restricciones artificiales 

Vy = 

/* = o 

(0 Z = ai 

fz= o 


O 

II 

K? 


n y = 0 

Restricciones naturales 

v x = 0 

O 

II 

co x — 0 

n z = 0 

0) v = 0 


z = o 


Restricciones artificiales 

v y — 0 

O 

II 

“z= «2 

n x = 0 


n y = 0 
fz = a 3 


FIGURA 11.2: Las restricciones naturales y artificiales para dos tareas. 
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libertad en {Cj debe especificarse una restricción de fuerza artificial, y viceversa. En 
cualquier instante, cualquier grado de libertad en la trama de restricción se controla pa¬ 
ra cumplir con una restricción de posición o de fuerza. 

Estrategia de ensamblaje es un término que hace referencia a una secuencia de res¬ 
tricciones artificiales planeadas que hacen que la tarea proceda en una manera deseable. 
Dichas estrategias deben incluir métodos mediante los cuales el sistema pueda detectar 
un cambio en la situación de contacto para que puedan rastrearse las transiciones en las 
restricciones naturales. Con cada cambio de ese tipo en las restricciones naturales, se 
recupera un nuevo conjunto de restricciones artificiales del conjunto de estrategias de 
ensamblaje para que el sistema de control las aplique. Los métodos para elegir automá¬ 
ticamente las restricciones para una tarea de ensamblaje dada requieren de más inves¬ 
tigación. En este capítulo vamos a suponer que se ha analizado una tarea para poder 
determinar las restricciones naturales y que un planeador humano ha determinado una 
estrategia de ensamblaje con la cual se va a controlar el manipulador. 

Hay que tener en cuenta que por lo general ignoraremos las fuerzas de fricción en¬ 
tre las superficies de contacto en nuestro análisis de las tareas. Esto bastará para nues¬ 
tra introducción al problema y, de hecho, producirá estrategias que funcionarán en 
muchos casos. Por lo general las fuerzas de fricción de deslizamiento actúan en direccio¬ 
nes elegidas para ser controladas en posición, y por lo tanto estas fuerzas aparecen co¬ 
mo perturbaciones para el servo de posición y son superadas por el sistema de control. 


EJEMPLO 11.1 

La figura 11.3(a)-(d) muestra una secuencia de ensamblaje utilizada para colocar una 
chaveta redonda en un hoyo redondo. La chaveta se baja hacia la superficie a la izquierda 
del hoyo y luego se desliza sobre la superficie hasta que cae en el hoyo. Después se inser¬ 
ta hasta que la chaveta llega hasta el fondo del hoyo, en donde el ensamblaje se considera 
completo. Cada una de las cuatro situaciones de contacto indicadas define una subtarea. 
Proporcione las restricciones naturales y artificiales para cada una de las subtareas mos¬ 
tradas. Además, indique cómo el subsistema detecta el cambio en las restricciones natu¬ 
rales a medida que procede la operación. 

Primero uniremos la trama de restricción a la chaveta, como se muestra en la fi¬ 
gura 11.3(a). En esta figura la chaveta está en espacio libre, por lo que las restricciones 
naturales son 

C T = 0. (H.l) 



FIGURA 11.3: La secuencia de cuatro situaciones de contacto para insertar una chaveta. 
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En este caso, las restricciones artificiales constituyen una trayectoria de posición com¬ 
pleta, la cual mueve a la chaveta en la dirección C Z hacia la superficie. Por ejemplo, 


c 


v 


i) 

0 

^acercamiento 

0 

o 

o 


( 11 . 2 ) 


en donde ri lcercam¡ent0 es la velocidad con la cual se acerca a la superficie. 

En la figura 11.3(b) la chaveta ha llegado a la superficie. Para detectar que esto 
ha ocurrido, observamos la fuerza en la dirección C Z. Cuando esta fuerza detectada pa¬ 
sa de un umbral determinamos el contacto, lo cual implica una nueva situación de con¬ 
tacto con un nuevo conjunto de restricciones naturales. Suponiendo que la situación de 
contacto es como se muestra en la figura 11.3(b), la chaveta no tiene la libertad de mo¬ 
verse en C Z ni de girar sobre C X o C Y. En los otros tres grados no tiene la libertad de 
aplicar fuerzas; por lo tanto, las restricciones naturales son 


v , = 0 , 
°>x = °’ 

CÚy = 0 , 

f x = o, 
'fy = 0 . 


n z = °- 


(11.3) 


Las restricciones artificiales describen la estrategia para deslizarse a lo largo de la su¬ 
perficie en la dirección C X mientras se aplican fuerzas pequeñas para asegurar que se 
mantenga el contacto. Por lo tanto, tenemos que 


v=v, 


deslizamiento’ 


V y = 0, 

CO Z = 0, 
fz = /« 


n x = 0, 

V 


c - = 0 . 


y 


(11.4) 


en donde / contacto es la fuerza que se aplica normal a la superficie a medida que se desliza 
la chaveta, y t> deslizamiento es la velocidad con la cual se desliza a través de la superficie. 

En la figura 11.3(c) la chaveta ha caído ligeramente dentro del hoyo. Esta situación 
se detecta observando la velocidad en la dirección C Z y esperando a que cruce un umbral 
(que se haga distinta de cero, en el caso ideal). Cuando esto ocurre, nos indica que una 
vez más han cambiado las restricciones naturales, y por lo tanto nuestra estrategia (como 
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se expresa en las restricciones artificiales) debe cambiar. Las nuevas restricciones natu¬ 
rales son 


-”, = o, 

:: v y = 0, 
w x = 0 , 
= 0 , 
c f x = 0. 


n z =Q. 


Elegimos las restricciones artificiales para que sean 


"- = °. 
7* = o, 
7 V = o, 


n , = 0 , 


C n y = 0, 


(11.5) 


( 11 . 6 ) 


en donde t> inserción es la velocidad a la que se inserta la chaveta en el hoyo. Finalmente, 
la situación que se muestra en la figura 11.3(d) se detecta cuando la fuerza en la direc¬ 
ción C Z aumenta por encima de un umbral. 


Es interesante observar que los cambios en las restricciones naturales siempre se 
detectan observando la variable de posición o de fuerza que no se está controlando. Por 
ejemplo, para detectar la transición de la figura 11.3(b) a la figura 11.3(c), monitorea- 
mos la velocidad en C Z mientras controlamos la fuerza en C Z. Para saber cuándo llega 
la chaveta al fondo del hoyo, monitoreamos c f\. aunque estamos controlando c v_. 

El marco de trabajo que hemos introducido es algo simplista. En la referencia [19] 
se podrá encontrar un método más general y riguroso de “dividir” las tareas en compo¬ 
nentes controlados por posición y componentes controlados por fuerza. 

La tarea de determinar estrategias de ensamblaje para ajustar piezas más compli¬ 
cadas entre sí es considerablemente compleja. También hemos ignorado los efectos de la 
incertidumbre en nuestro sencillo análisis de esta tarea. El desarrollo de sistemas de 
planeación automática que incluyen los efectos de la incertidumbre y pueden aplicarse 
a situaciones prácticas ha sido un tema de investigación [4-8] desde hace tiempo. Para 
una buena revisión de estos métodos consulte la referencia [9]. 

11.4 EL PROBLEMA DE CONTROL HÍBRIDO DE POSICIÓN/FUERZA 

La figura 11.4 muestra dos ejemplos extremos de situaciones de contacto. En la figura 
11.4(a), el manipulador se está moviendo a través del espacio libre. En este caso, las 
restricciones naturales son todas de fuerza; no hay nada contra qué reaccionar, por lo 
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(a) 


¿i i 



/ 


N 


FIGURA 11.4: Los dos extremos en situaciones de contacto. El manipulador a la izquierda 
se mueve en el espacio libre, en donde no existe una superficie de reacción. El manipula¬ 
dor a la derecha está pegado a la pared, por lo que no es posible el movimiento libre. 

que todas las fuerzas se restringen para hacerse cero. 1 Con un brazo que tiene seis gra¬ 
dos de libertad, podemos movernos en seis grados de libertad en posición pero no es 
posible ejercer fuerzas en ninguna dirección. La figura 11.4(b) muestra la situación ex¬ 
trema de un manipulador con su efector final pegado a una pared. En este caso, el ma¬ 
nipulador está sujeto a seis restricciones naturales de posición ya que no está libre para 
reposicionarse. No obstante, el manipulador está libre para ejercer fuerzas y momen¬ 
tos de torsión sobre el objeto con seis grados de libertad. 

En los capítulos 9 y 10 estudiamos el problema de control de posición que se apli¬ 
ca a la situación de la figura 11.4(a). La situación de la figura 11.4(b) no ocurre muy a 
menudo en la práctica; generalmente debemos considerar el control de la fuerza en el 
contexto de tareas parcialmente restringidas en las que ciertos grados de libertad del 
sistema están sujetos al control de posición y otros están sujetos al control de fuerza. 
Por lo tanto, en este capítulo consideraremos los esquemas híbridos de control de po¬ 
sición/fuerza. 

El controlador híbrido de posición/fuerza debe resolver tres problemas: 

1. El control de la posición de un manipulador sobre las direcciones en las que exis¬ 
ta una restricción natural de fuerza. 

2. El control de la fuerza de un manipulador sobre las direcciones en las que exista 
una restricción natural de posición. 

3. Un esquema para implementar la mezcla arbitraria de esos modos sobre los gra¬ 
dos de libertad ortogonales de una trama arbitraria ¡C¡. 

11.5 CONTROL DE FUERZA DE UN SISTEMA DE MASA-RESORTE 

En el capítulo 9 comenzamos nuestro estudio del problema completo de control de po¬ 
sición con el estudio del problema bastante simple de controlar un solo bloque de ma¬ 
sa. Después, en el capítulo 10 pudimos utilizar un modelo del manipulador de tal forma 
que el problema de controlar todo el manipulador se hizo equivalente a controlar n masas 

1 Es importante recordar que aquí nos concentramos en las fuerzas de contacto entre el efector final y el 
entorno, no en las fuerzas inerciales. 
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independientes (para un manipulador con n articulaciones). De manera similar, comen¬ 
zamos nuestro análisis del control de fuerza controlando la fuerza aplicada por un sis¬ 
tema simple con un solo grado de libertad. 

Al considerar las fuerzas de contacto debemos hacer un modelo del entorno so¬ 
bre el cual estamos actuando. Para los fines del desarrollo, conceptual utilizaremos un 
modelo muy simple de interacción entre un cuerpo controlado y el entorno. Modelaremos 
el contacto con un entorno como un resorte; esto es, supondremos que nuestro sistema es 
rígido y que el entorno tiene cierta rigidez, la cual está representada por k . 

Consideremos el control de una masa unida a un resorte, como en la figura 11.5. 
También incluiremos una fuerza de perturbación desconocida, representada por f r la 
cual podría considerarse como un modelo para la fricción desconocida o los dientes en 
el engranaje del manipulador. La variable que deseamos controlar es la fuerza que ac¬ 
túa en el entorno, f e , que es la fuerza que actúa en el resorte: 


fe = K x - 


(11.7) 


La ecuación que describe este sistema físico es 

/ = mx + k e x + / pert , 

o, si se escribe en términos de la variable que deseamos controlar, / 


( 11 . 8 ) 


/ = mk e 1 fe + fe + /pert' 


(11.9) 


Usando el concepto de controlador particionado, así como 

a = mk ~ 1 


e 


y 


P - fe + /pert 


llegamos a la ley de control, 



( 11 . 10 ) 



FIGURA 11.5: Un sistema de resorte-masa. 
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en donde e y = f d — f e es el error de fuerza entre la fuerza deseada, f d , y la fuerza detec¬ 
tada en el entorno,/ Si pudiéramos calcular la ecuación (11.10), tendríamos el sistema 
de lazo cerrado 


' é f + k vf é f+ k pf e f=°- ( 11 . 11 ) 

Sin embargo, no podemos utilizar el conocimiento de / en nuestra ley de con¬ 
trol, por lo que la ecuación (11.10) no es viable. Podríamos dejar ese término fuera de 
la ley de control, pero un análisis de estado estable muestra que hay una mejor opción, 
especialmente cuando la rigidez del entorno ( k ) es alta (la situación usual). 

Si optamos por dejar el término/ fuera de nuestra ley de control, igualamos las 
ecuaciones (11.9) y (11.10) y hacemos un análisis de estado estable haciendo que todas 
las derivadas en el tiempo sean cero, tendremos que 

= 4*2 ( 11 . 12 ) 


en donde a = mk~ x k la ganancia de retroalimentación de fuerza efectiva; no obstante, 
si optamos por usar f d en la ley de control (11.10) en vez del término f g + f , encon¬ 
traremos que el error de estado estable será 


e f = 


/dist 

1 + a 


(11.13) 


Cuando el entorno es rígido (como es común en este caso) a podría ser pequeña, 
de tal forma que el error calculado en la ecuación (11.13) es una mejora considerable res¬ 
pecto al de la ecuación (11.12). Por lo tanto, sugerimos la siguiente ley de control: 


/ = mk e 1 [fd 


k vf é f 


k p.f e f 


fd- 


(11.14) 


La figura 11.6 es un diagrama de bloques del sistema de lazo cerrado que utiliza la 
ley de control (11.14). 

En general, las consideraciones prácticas cambian la implementación de un servo 
de control de fuerza de manera considerable, a diferencia del ideal que se muestra en 
la figura 11.6. En primer lugar, las trayectorias de fuerza son generalmente constantes; 


/o" 


Íd- 
Íd - 



^2 


mk p 



Sistema 


/= mx + k e x + 


K 

pf 




K, 


pf 


d_ 

dt 


£>. 


FIGURA 11.6: Un sistema de control de fuerza para el sistema de resorte-masa. 
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FIGURA 11.7: Un sistema práctico de control de fuerza para el sistema de resorte-masa. 


esto es, por lo general nos interesa controlar la fuerza de contacto para que esté a cier¬ 
to nivel constante. Son raras las aplicaciones en las que las fuerzas de contacto deban 
seguir cierta función arbitraria de tiempo. Por lo tanto, las entradas f d y f d del sistema 
de control muy a menudo se establecen permanentemente en cero. Otra realidad es 
que las fuerzas detectadas son bastante “ruidosas”, por lo que sería imprudente usar la 
diferenciación numérica para calcular f e . No obstante, f e — k e x, por lo que podemos 
obtener la derivada de la fuerza en el entorno como f = k x. Esto es mucho más rea¬ 
lista ya que la mayoría de los manipuladores tiene los medios para obtener buenas 
medidas de velocidad. Después de haber hecho estas dos elecciones pragmáticas, escri¬ 
bimos la ley de control como 


/ — m 




*-vf A 


fd’ 


(11.15) 


con el correspondiente diagrama de bloques que se muestra en la figura 11.7. 

Considere que una interpretación del sistema de la figura 11.7 es que los errores 
de fuerza generan un punto de ajuste para un lazo interno de control de velocidad con 
una ganancia k,- Algunas leyes de control de fuerza también incluyen un término in¬ 
tegral para mejorar el rendimiento en estado estable. 

Un importante problema remanente es que la rigidez del entorno k e aparece en 
nuestra ley de control, pero a menudo se desconoce y tal vez cambia ocasionalmente. 
Sin embargo, con mucha frecuencia un robot de ensamblaje trata con piezas rígidas, 
por lo que podría pensarse que k p sería bastante alta. Generalmente se hace esta supo¬ 
sición, y las ganancias se seleccionan de tal forma que el sistema sea algo robusto res¬ 
pecto a variaciones en k p . 

El propósito de construir una ley para controlar la fuerza de contacto ha sido el 
de mostrar una estructura que ha sido sugerida y exponer algunos puntos importan¬ 
tes. Durante el resto de este capítulo simplemente supondremos que podría construir¬ 
se dicho servo de control de fuerza y abstraerlo en una caja negra, como se muestra en 
la figura 11.8. En la práctica no es fácil construir un servo de fuerza de alto rendimien¬ 
to, lo que es en la actualidad un área de mucha investigación [11-14]. Para una buena 
revisión de este tema consulte la referencia [15]. 
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FIGURA 11.8: El servo de control de fuerza como una caja negra. 

11.6 EL ESQUEMA DE CONTROL HÍBRIDO DE POSICIÓN/FUERZA 

En esta sección presentaremos una arquitectura para un sistema de control que imple- 
menta el controlador híbrido de posición/fuerza. 

Un manipulador cartesiano alineado con {C} 

Primero consideraremos el caso simple de un manipulador con tres grados de libertad y ar¬ 
ticulaciones prismáticas que actúa en las direcciones Z,Y y X. Por sencillez supondremos 
que cada vínculo tiene una masa m y se desliza sobre cojinetes libres de fricción. Vamos a 
suponer también que los movimientos de las articulaciones se alinean exactamente con la 
trama de restricción ¡Cj. El efector final está en contacto con una superficie de rigidez k e 
orientada con su normal en la dirección — C Y. Por lo tanto se requiere el control de fuerza 
en esa dirección, pero el control de posición en las direcciones C X y C Z. (Vea la figura 11.9). 

En este caso, la solución al problema del control híbrido de posición/fuerza es cla¬ 
ra. Debemos controlar las articulaciones 1 y 3 con el controlador de posición que desa¬ 
rrollamos para una masa unitaria en el capítulo 9. La articulación 2 (que opera en la 
dirección É) debe manejarse con el controlador de fuerza que desarrollamos en la sec¬ 
ción 11.4. Podríamos entonces suministrar una trayectoria de posiciones en las direccio¬ 
nes C X y C Z, y al mismo tiempo podríamos suministrar una trayectoria de fuerzas (tal 
vez sólo una constante) en la dirección C Y. 

Si deseamos poder cambiar la naturaleza de la superficie de restricción de tal for¬ 
ma que su normal pueda también ser X o Z, podemos generalizar ligeramente nuestro 
sistema de control de brazo cartesiano de la siguiente manera: construiremos la estructu¬ 
ra del controlador de tal forma que podamos especificar una trayectoria de posiciones 
completa en los tres grados de libertad, y también una trayectoria de fuerzas en esos mis¬ 
mos tres grados. Desde luego no podemos controlar esto de manera que se cumplan es¬ 
tas seis restricciones en un momento dado; pero sí podemos establecer modos de indicar 
qué componentes de qué trayectoria se seguirán en cualquier momento dado. 

Considere el controlador que se muestra en la figura 11.10. Aquí indicamos el 
control de las tres articulaciones de nuestro brazo cartesiano simple en un diagrama 
sencillo, mostrando tanto el controlador de posición como el controlador de fuerza. Se 
han introducido las matrices S y S' para definir el modo (posición o fuerza) que se va 
a utilizar para controlar cada articulación del brazo cartesiano. La matriz S es diagonal, 
con unos y ceros en la diagonal. 
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FIGURA 11.9: Un manipulador cartesiano con tres grados de libertad en contacto con una 
superficie. 



FIGURA 11.10: El controlador híbrido para un brazo cartesiano 3-DOF. 


Cuando hay un uno presente en S, hay un cero presente en S' y el control de po¬ 
sición está en efecto. Cuando hay un cero presente en S, hay un uno presente en S' y el 
control de fuerza está en efecto. Por ende, las matrices S y S' son simplemente interrup¬ 
tores que establecen el modo de control a utilizar con cada grado de libertad en ¡C). De 
acuerdo con la configuración de S, siempre hay tres componentes de la trayectoria que 
se están controlando, aunque la mezcla entre control de posición y de fuerza es arbitra¬ 
ria. Se ignoran los otros tres componentes de trayectoria deseada y errores de servo 
asociados; en consecuencia, cuando cierto grado de libertad está bajo el control de fuer¬ 
za se ignoran los errores de posición en ese grado de libertad. 
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EJEMPLO 11.2 

Encuentre las matrices S y S' para la situación que se muestra en la figura 11.9, con los 
movimientos en la dirección C Y restringidos por la superficie de reacción. 

Como los componentes X y Z se van a controlar por posición, introducimos unos 
en la diagonal de S que sean correspondientes a estos dos componentes. Esto hará que 
el servo de posición se active en estas dos direcciones y se seguirá la trayectoria de en¬ 
trada; se ignorará cualquier entrada de trayectoria de posiciones para el componente 
Y. La matriz S ' tiene los unos y ceros invertidos en la diagonal; por lo tanto, tenemos 


5 = 

S' = 


1 0 0 
0 0 0 
0 0 1 

0 0 0 
0 10 
0 0 0 


(11.16) 


La figura 11.10 muestra el controlador híbrido para el caso especial en que las ar¬ 
ticulaciones se alinean exactamente con la trama de restricción |C¡. En la siguiente sub¬ 
sección utilizaremos las técnicas estudiadas en capítulos anteriores para generalizar el 
controlador para trabajar con manipuladores generales y para una ¡Cj arbitraria. No 
obstante, en el caso ideal el sistema funciona como si el manipulador tuviera un actua- 
dor “alineado” con cada grado de libertad en {Cj. 

Un manipulador general 

El proceso de generalizar el controlador híbrido mostrado en la figura 11.10 de mane¬ 
ra que pueda usarse un manipulador general es sencillo con el concepto del control de 
base cartesiana. En el capítulo 6 vimos cómo escribir las ecuaciones de movimiento 
de un manipulador en términos del movimiento cartesiano del efector final, y en el ca¬ 
pítulo 10 vimos cómo utilizar dicha formulación para lograr un control de posición car¬ 
tesiano desacoplado de un manipulador. La idea principal es que, a través del uso de un 
modelo dinámico escrito en espacio cartesiano, es posible controlar de manera tal que 
el sistema combinado del manipulador actual y del modelo calculado aparezcan como 
un conjunto de masas unitarias desacopladas e independientes. Una vez realizados es¬ 
tos procesos de desacoplamiento y linealización, podemos aplicar el servo simple desa¬ 
rrollado en la sección 11.4. 

La figura 11.11 muestra la compensación basada en la formulación de la dinámi¬ 
ca del manipulador en espacio cartesiano, de tal forma que el manipulador aparezca co¬ 
mo un conjunto de masas unitarias desacopladas. Para usarse en el esquema de control 
híbrido, la dinámica cartesiana y el jacobiano se escriben en la trama de restricción {Cj. 
De igual forma, la cinemática se calcula respecto a la trama de restricción. 

Como hemos diseñado el controlador híbrido para un manipulador cartesiano ali¬ 
neado con la trama de restricción, y como el esquema de desacoplamiento cartesiano nos 
proporciona un sistema con las mismas propiedades de entrada-salida, sólo necesitamos 
combinarlos para generar el controlador híbrido generalizado de posición/fuerza. 

La figura 11.12 es un diagrama de bloques del controlador híbrido para un mani¬ 
pulador general. Observe que la dinámica está escrita en la trama de restricción, al 
igual que el jacobiano. 
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FIGURA 11.11: El esquema de desacoplamiento cartesiano introducido en el capítulo 10. 



FIGURA 11.12: El controlador híbrido de posición/fuerza para un manipulador general. 
Por simplicidad no se ha mostrado el lazo de velocidad-retroalimentación. 


Las ecuaciones cinemáticas están escritas para incluir la transformación de coordenadas 
en la trama de restricción, y las fuerzas detectadas se transforman de igual forma en {C¡. 
Los errores de servo se calculan en ¡C) y los modos de control dentro de ¡C) se estable¬ 
cen a través de la elección apropiada de S. 2 La figura 11.13 muestra un manipulador con¬ 
trolado por un sistema de este tipo. 


2 La partición de los modos de control a lo largo de ciertas direcciones relacionadas con la tarea se ha 
generalizado en [10], con base en el método más básico que se presentó en este capítulo. 
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FIGURA 11.13: Un manipulador PUMA 560 lava una ventana bajo el control del sistema 
COSMOS desarrollado bajo la responsabilidad de O. Khatib en la Universidad de Stan- 
ford. Estos experimentos utilizan dedos detectores de fuerzas y una estructura de control 
similar a la de la figura 11.12 [10]. 


Cómo agregar rigidez variable 

La acción de controlar un grado de libertad en un estricto control de posición o de fuer¬ 
za representa el control en dos extremos del espectro de rigidez del servo. Un servo de 
posición ideal es infinitamente rígido y rechaza todas las perturbaciones de fuerza que 
actúan en el sistema. En contraste, un servo de fuerza ideal exhibe cero rigidez y man¬ 
tiene la aplicación de fuerza deseada sin importar las perturbaciones de posición. Po¬ 
dría ser útil controlar el efector final para exhibir rigideces distintas de cero o infinito. 
En general, podría ser conveniente controlar la impedancia mecánica del efector final 
[14,16,17]. 

En nuestro análisis del contacto hemos imaginado que el entorno es muy rígido. 
Cuando hacemos contacto con un entorno rígido, utilizamos un control de fuerza con 
cero rigidez; y cuando hacemos contacto con cero rigidez (movimiento en espacio li¬ 
bre), utilizamos un control de posición con alta rigidez. Por ende, parece que controlar 
el efector final para exhibir una rigidez que sea aproximadamente la inversa del entor¬ 
no local es una buena estrategia. En consecuencia, al tratar con piezas de plástico o re¬ 
sortes podría ser conveniente establecer una rigidez del servo distinta de cero o infinito. 

Dentro del marco de trabajo del controlador híbrido, esto se hace simplemente 
utilizando el control de posición y reduciendo la ganancia de posición que corresponde 
al grado apropiado de libertad en [C¡. En general, al hacer eso se reduce la ganancia 
de velocidad de manera que el grado de libertad siga siendo críticamente amortiguado. 
La habilidad de cambiar las ganancias de posición y de velocidad del servo de posición 
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a lo largo de los grados de libertad de {C¡ permite al controlador híbrido de posición/ 
fuerza implementar una impedancia generalizada del efector final [17]. No obstante, en 
muchas situaciones prácticas estamos tratando con la intersección de piezas rígidas de 
manera que se desea el control puro de posición o el control puro de fuerza. 

11.7 ESQUEMAS DE CONTROL DE ROBOTS INDUSTRIALES EN LA ACTUALIDAD 

El verdadero control de fuerza, como el controlador híbrido de posición/fuerza que pre¬ 
sentamos en este capítulo, no existe actualmente en los robots industriales. Entre los 
problemas de implementación práctica están la enorme cantidad de poder de cómputo 
requerido, la falta de parámetros precisos para el modelo dinámico, la falta de senso¬ 
res de fuerza de uso rudo y el nivel de dificultad impuesto al usuario para especificar 
una estrategia de posición/fuerza. 

Adaptabilidad pasiva 

Los manipuladores extremadamente rígidos con servos de posición muy rígidos son 
inadecuados para las tareas en las que las piezas entran en contacto y se generan fuerzas 
de contacto. En tales situaciones es frecuente que las piezas se atoren o se dañen. Desde 
los primeros experimentos con los manipuladores que intentaban realizar ensamblajes 
se dedujo que, en la medida en que los robots podían realizar dichas tareas, se debía a 
la adaptabilidad de las piezas, o de los dispositivos fijos, o del brazo en sí. Esta habili¬ 
dad de una o más piezas del sistema de “ceder” un poco era a menudo suficiente para 
permitir la unión exitosa de las piezas. 

Una vez que se dedujo lo anterior, se diseñaron dispositivos especiales para intro¬ 
ducir a propósito adaptabilidad en el sistema. El dispositivo más exitoso de ese tipo es 
el RCC o dispositivo de adaptabilidad de centro remoto, desarrollado en Draper Labs 
[18]. El RCC fue diseñado inteligentemente de manera que introdujera el tipo “correc¬ 
to” de adaptabilidad, lo que permitía que ciertas tareas se llevaran a cabo sin proble¬ 
mas y rápidamente con poca o ninguna probabilidad de atascamientos. El RCC es 
básicamente un resorte con seis grados de libertad que se inserta entre la muñeca del 
manipulador y el efector final. Al ajustar las rigideces de los seis resortes pueden intro¬ 
ducirse diversos niveles de adaptabilidad. Dichos esquemas se conocen como esquemas 
de adaptabilidad pasiva y se utilizan en aplicaciones industriales de manipuladores en 
ciertas tareas. 

Adaptabilidad mediante la suavización de las ganancias de posición 

En lugar de lograr la adaptabilidad en una forma pasiva, y por lo tanto fija, es posible crear 
esquemas en los que la aparente rigidez del manipulador se altere a través del ajuste de las 
ganancias de un sistema de control de posición. Algunos robots industriales hacen algo pa¬ 
recido para aplicaciones tales como el triturado, en donde es necesario mantener contac¬ 
to con una superficie pero no se requiere el control delicado de la fuerza. 

Salisbury [16] ha sugerido un método especialmente interesante. En este esque¬ 
ma, las ganancias de posición en un sistema de servo basado en articulación se modifican 
de forma tal que el efector final parezca tener cierta rigidez a lo largo de los grados car¬ 
tesianos de libertad: considere un resorte general con seis grados de libertad. Su acción 
podría describirse por 


r = K px 8 X , 


( 11 . 17 ) 
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en donde K es una matriz diagonal de 6 x 6 con tres rigideces lineales seguidas por 
tres rigideces torsionales en la diagonal. ¿Cómo podríamos hacer que el efector final de 
un manipulador exhibiera esta característica de rigidez? 

Recordando la definición del jacobiano del manipulador, tenemos que 

S X = 7(0)5©. (11.18) 

Si la combinamos con la ecuación (11.17) obtenemos 

T= K px J(®)8®. (11.19) 

De las consideraciones de fuerza estática tenemos que 

r = J T (®)F, (11.20) 

lo que, combinado con la ecuación (11.19), nos produce 

r = J T (@)K px J(@)S&. (11.21) 

Aquí el jacobiano se escribe generalmente en la trama herramienta. La ecuación (11.21) 
es una expresión para la forma en que deben generarse los momentos de torsión de una 
articulación como una función de pequeños cambios en los ángulos de articulación 50, 
para poder hacer que el efector final del manipulador se comporte como un resorte car¬ 
tesiano con seis grados de libertad. 

Mientras que un simple controlador de posición basado en articulación podría 
utilizar la ley de control 


r = K p E + K v É, (11.22) 

en donde K p y K v son matrices diagonales de ganancias constantes y £ es el error de 
servo definido como 0 f/ — 0, Salisbury sugiere utilizar 

r = J T (®)K px J(@)E + K V É, (11.23) 

en donde K px es la rigidez deseada del efector final en espacio cartesiano. Para un ma¬ 
nipulador con seis grados de libertad, K px es una matriz diagonal con los seis valores de 
la diagonal que representan las tres rigideces traslacionales y las tres rigideces de rota¬ 
ción que va a exhibir el efector final. Básicamente, mediante el uso del jacobiano se ha 
transformado una rigidez cartesiana en una rigidez en el espacio de articulación. 

Detección de fuerza 

La detección de fuerza permite a un manipulador detectar el contacto con una superficie 
y, utilizando esta sensación, realizar alguna acción. Por ejemplo, el término movimiento 
protegido se utiliza algunas veces para indicar la estrategia de moverse bajo el control 
de posición hasta que se detecta una fuerza para después detener el movimiento. Ade¬ 
más, la detección de fuerza puede utilizarse como una verificación simple durante una 
operación de manejo de piezas para asegurar que se haya adquirido una pieza o que se 
haya adquirido la pieza apropiada. 

Algunos robots disponibles comercialmente vienen equipados con sensores de 
fuerza en el efector final. Estos robots pueden programarse para detener el movimiento 
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o tomar cualquier otra acción cuando se excede un umbral de fuerza, y algunos pueden 
ser programados para pesar objetos que se sujeten en el efector final. 
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EJERCICIOS 

11.1 [12] Encuentre las restricciones naturales presentes para una chaveta de corte trans¬ 
versal cuadrado que se desliza en un hoyo de corte transversal cuadrado. Muestre su 
definición de [C] en un bosquejo. 

11.2 [10] Encuentre las restricciones artificiales (es decir, la trayectoria) que sugeriría para 
hacer que la chaveta del ejercicio 11.1 se deslice más abajo en el hoyo sin atascarse. 

11.3 [20] Demuestre que al usar la ley de control (11.4) con un sistema dado por la ecua¬ 
ción (11.9) se produce la siguiente ecuación en el espacio de error: 

’éf + K f é f + ( k P f + m~ 1 k e )e f = mT 1 k e f peTt , 

y que por consecuencia es posible elegir ganancias para proporcionar un amortigua¬ 
miento crítico sólo si se conoce la rigidez del entorno, representada por k . 

11.4 [17] Dada 


A 

B 


T = 


-0.866 -0.500 0.000 10.0" 
0.500 0.866 0.000 0.0 

0.000 0.000 1.000 5.0 

0 0 0 1 . 


si el vector de fuerza-momento de torsión en el origen de {A} es 

- 0.0 - 
2.0 


0.0 
4.0 _ 

encuentre el vector de fuerza-momento de torsión de 6 x 1 con el punto de referen¬ 
cia en el origen de {B ]. 

11.5 Dada 


A 

B 


T = 


0.866 0.500 0.000 10.0“ 
-0.500 0.866 0.000 0.0 

0.000 0.000 1.000 5.0 
0 0 0 1 . 


si el vector de fuerza-momento de torsión en el origen de {A} es 


A 


V = 


- 6.0 - 
6.0 
0.0 
5.0 
0.0 
0.0 


encuentre el vector de fuerza-momento de torsión de 6 x 1 con el punto de referen¬ 
cia en el origen de {B ]. 

11.6 [18] Describa en español cómo lograría insertar un libro en un hueco estrecho entre 

los libros de su atestada repisa. 
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FIGURA 11.14: Un bloque restringido por un piso debajo y una pared al lado. 

11.7 [20] Encuentre las restricciones naturales y artificiales para la tarea de cerrar una 
puerta tipo batiente con un manipulador. Haga todas las suposiciones necesarias. 
Muestre su definición de [C] en un bosquejo. 

11.8 [20] Encuentre las restricciones naturales y artificiales para la tarea de descorchar 
una botella de champaña con un manipulador. Haga todas las suposiciones necesa¬ 
rias. Muestre su definición de [C] en un bosquejo. 

11.9 [41] Para el sistema de servo de rigidez de la sección 11.7 no hemos declarado que 
sea estable. Suponga que se utiliza la ecuación (11.23) como la porción de servo de 
un manipulador desacoplado y lincalizado (de manera que las n articulaciones apa¬ 
rezcan como masas unitarias). Demuestre que el controlador es estable para cual¬ 
quier K que sea negativa definida. 

11.10 [48] Para el sistema de servo de rigidez de la sección 11.7 no hemos declarado que 
sea o que pueda ser críticamente amortiguado. Suponga que se utiliza la ecuación 
(11.23) como la porción de servo de un manipulador desacoplado y linealizado (de 
manera que las n articulaciones aparezcan como masas unitarias). ¿Es posible dise¬ 
ñar una K que sea una función de © y haga que el sistema sea críticamente amorti¬ 
guado sobre todas las configuraciones? 

11.11 [15] Como se muestra en la figura 11.14, un bloque está restringido en la parte de 
abajo por un piso y por la pared en un lado. Suponiendo que esta situación de con¬ 
tacto se mantenga por un tiempo definido, proporcione las restricciones naturales 
que estén presentes. 

EJERCICIO DE PROGRAMACIÓN (PARTE 11) 

Implemente un sistema de control de rigidez cartesiano para el manipulador planar de tres 
vínculos, utilizando la ley de (11.23) para controlar el brazo simulado. Use el jacobiano es¬ 
crito en la trama ¡3). 

Para el manipulador en la posición 0 = [60.0, —90.0 30.0] y para K de la forma 

^chica 0.0 0.0 

°-° Agrande 

0.0 0.0 fc grande _ 
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simule la aplicación de las siguientes fuerzas estáticas: 

1. Una fuerza de 1 newton que actúa en el origen de {3} en la dirección X 3 . 

2. Una fuerza de 1 newton que actúa en el origen de {3} en la dirección Y 3 . 

Los valores de k chica y k grande deben encontrarse en forma experimental. Use un va¬ 
lor grande de k ande para una rigidez alta en la dirección F 3 y un valor chico de k chica pa¬ 
ra una rigidez baja en la dirección X 3 . ¿Cuáles son las deflexiones de estado estable en los 
dos casos? 
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12.1 INTRODUCCIÓN 

12.2 LOS TRES NIVELES DE PROGRAMACIÓN DE ROBOTS 

12.3 UN EJEMPLO DE APLICACIÓN 

12.4 REQUERIMIENTOS DE UN LENGUAJE DE PROGRAMACIÓN DE ROBOTS 

12.5 PROBLEMAS PECULIARES PARA LOS LENGUAJES DE PROGRAMACIÓN DE ROBOTS 


12.1 INTRODUCCIÓN 

En este capítulo empezaremos a considerar la interfaz entre el usuario humano y un ro¬ 
bot industrial. Es mediante esta interfaz que un usuario puede aprovechar todos los al¬ 
goritmos de mecánica y de control subyacentes que hemos estudiado en capítulos 
anteriores. 

La sofisticación de la interfaz de usuario se ha vuelto en extremo importante a 
medida que los manipuladores y demás tipos de automatización programable se em¬ 
plean en cada vez más aplicaciones industriales demandantes. La naturaleza de la in¬ 
terfaz de usuario es una cuestión muy importante; de hecho, la mayor parte del reto del 
diseño y uso de robots industriales prioriza este aspecto del problema. 

Los manipuladores robots se diferencian a sí mismos de la automatización fija al 
ser “flexibles”, lo cual significa que son programables. No sólo son programables los 
movimientos de los manipuladores sino que, a través del uso de sensores y comunica¬ 
ción con otros tipos de automatización de fábrica, los manipuladores pueden adaptar¬ 
se a las variaciones a medida que se desarrolle la tarea. 

Al considerar la programación de manipuladores es importante recordar que ge¬ 
neralmente son sólo una parte mínima de un proceso automatizado. El término célula 
de trabajo se utiliza para describir una colección local de equipo, que puede incluir uno 
o más manipuladores, sistemas de transportadores, alimentadores de piezas y disposi¬ 
tivos fijos. En el siguiente nivel más alto, las células de trabajo pueden interconectarse 
en redes distribuidas en toda la fábrica, de manera que una computadora central pue¬ 
da controlar todo el flujo. Por ende la programación de manipuladores se considera co¬ 
múnmente dentro del problema más amplio de programar una variedad de máquinas 
interconectadas en una célula de trabajo de fábrica automatizada. 

A diferencia de los 11 capítulos anteriores, el material de este capítulo (y del si¬ 
guiente) es de una naturaleza que cambia constantemente; por lo tanto, es difícil pre¬ 
sentarlo de forma detallada. Trataremos de resaltar los conceptos fundamentales 
subyacentes y dejaremos al lector la tarea de buscar los ejemplos más recientes. 
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12.2 LOS TRES NIVELES DE PROGRAMACIÓN DE ROBOTS 

A través del tiempo se han desarrollado muchos estilos de interfaz de usuario para pro¬ 
gramar robots. Antes de la rápida proliferación de microcomputadoras en la industria, los 
controladores de robots se asemejaban a los secuenciadores simples utilizados a menudo 
para controlar la automatización fija. Los métodos modernos se enfocan en la programa¬ 
ción de computadoras, y las cuestiones relacionadas con la programación de robots inclu¬ 
yen todo lo referente a la programación de computadoras en general; y más. 

Enseñar mostrando 

Los primeros robots se programaban mediante un método al que llamaremos enseñar 
mostrando, el cual implicaba mover el robot a un punto de destino deseado y registrar 
su posición en una memoria que el secuenciador leería durante la reproducción. Du¬ 
rante la fase de enseñanza, el usuario guiaba al robot ya sea en forma manual o a tra¬ 
vés de la interacción con un dispositivo de enseñanza. Los dispositivos de enseñanza 
son cajas de botones portátiles que permiten el control de cada articulación del mani¬ 
pulador o de cada grado de libertad cartesiano. Algunos controladores de este tipo 
permiten las pruebas y las ramificaciones, por lo que pueden introducirse simples pro¬ 
gramas que involucren la lógica. Algunos dispositivos de enseñanza tienen pantallas al- 
fanuméricas y se aproximan en complejidad a las terminales portátiles. La figura 12.1 
muestra a un operador utilizando un dispositivo de enseñanza para programar un ro¬ 
bot industrial. 



FIGURA 12.1: El GMF 380 se utiliza comúnmente en aplicaciones de soldadura por 
puntos en carrocerías automotrices. Aquí, un operador utiliza una interfaz de disposi¬ 
tivo de enseñanza para programar el manipulador. Fotografía cortesía de GMFanuc 
Corp. 
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Lenguajes de programación de robots explícitos 

Con la llegada de computadoras baratas y poderosas, la tendencia se ha orientado ca¬ 
da vez más hacia la programación de robots mediante programas escritos en lenguajes 
de programación de computadoras. Generalmente estos lenguajes tienen característi¬ 
cas especiales que se aplican a los problemas de la programación de manipuladores y 
por ello se les llama lenguajes de programación de robots (RPL). La mayoría de los sis¬ 
temas que vienen equipados con un lenguaje de este tipo han retenido además una in¬ 
terfaz estilo dispositivo de enseñanza. 

Dado que los lenguajes de programación de robots han tomado muchas formas, 
los dividiremos en tres categorías: 

1. Lenguajes de manipulación especializados. Se han creado desarrollando un len¬ 
guaje completamente nuevo que, aunque se enfoca en áreas específicas de los ro¬ 
bots, podría considerarse un lenguaje general de programación de computadoras. 
Un ejemplo es el lenguaje VAL desarrollado para controlar los robots industria¬ 
les de Unimation, Inc. [1]. VAL se desarrolló específicamente como un lenguaje 
de control de manipuladores pues como lenguaje general de computadoras era 
bastante débil. Por ejemplo, no soportaba números de punto flotante o cadenas 
de caracteres, y las subrutinas no podían pasar argumentos. V-II, una versión 
más reciente, ya contaba con estas características [2]. V+, la encamación actual 
de este lenguaje, incluye muchas características nuevas [13]. Otro ejemplo de un 
lenguaje de manipulación especializado es AL, desarrollado en la Universidad de 
Stanford [3]. Aunque el lenguaje AL es ahora una reliquia, de todas formas 
proporciona buenos ejemplos de algunas características que todavía no se en¬ 
cuentran en la mayoría de los lenguajes modernos (control de fuerza, paralelis¬ 
mo). Además, como fue construido en un entorno académico, hay referencias 
disponibles para describirlo [3]. Por estas razones seguimos haciendo referencia a 
este lenguaje. 

2. Biblioteca de robótica para un lenguaje de computación existente. Estos lengua¬ 
jes se han desarrollado a partir de un lenguaje popular de computación (por ejem¬ 
plo, Pascal) al que se le agrega una biblioteca de subrutinas específicas para 
robots. El usuario escribe un programa en Pascal haciendo uso de llamadas fre¬ 
cuentes al paquete de subrutinas predefinido para las necesidades específicas del 
robot. Un ejemplo es AR-BASIC de American Cimflex [4], que esencialmente es 
una biblioteca de subrutinas para una implementación estándar de BASIC. 
JARS, desarrollado por el Laboratorio de Propulsión a Chorro de la NASA, es 
un ejemplo de dicho lenguaje de programación de robots basado en Pascal [5]. 

3. Biblioteca de robótica para un nuevo lenguaje de propósito general. Estos len¬ 
guajes de programación de robots se han desarrollado creando primero un 
nuevo lenguaje de propósito general como base de programación y después sumi¬ 
nistrando una biblioteca de subrutinas predefinidas, específicas para robots. 
Ejemplos de estos lenguajes de programación son RAPID, desarrollado por ABB 
Robotics [6]; AML, desarrollado por IBM [7], y KAREL, desarrollado por 
GMF Robotics [8], 

Los estudios de programas de aplicación reales para células de trabajo robóticas 
han demostrado que un gran porcentaje de las instrucciones del lenguaje no son espe¬ 
cíficas para los robots [7], sino que la mayor parte de la programación de robots tiene 
que ver con la inicialización, prueba lógica y ramificación, comunicación, etcétera. Por 
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esta razón, podría desarrollarse una tendencia a alejarse del desarrollo de lenguajes es¬ 
peciales para la programación de robots y moverse hacia el desarrollo de extensiones 
para lenguajes generales, como en las categorías 2 y 3 antes mencionadas. 

Lenguajes de programación a nivel de tarea 

El tercer nivel de la metodología de programación de robots está relacionado con los 
lenguajes de programación a nivel de tarea. Estos lenguajes permiten al usuario orde¬ 
nar directamente las submetas deseadas de la tarea, en vez de especificar los detalles 
de cada acción que el robot va a llevar a cabo. En dicho sistema el usuario puede incluir 
instrucciones en el programa de aplicación, con un nivel considerablemente más alto 
que en un lenguaje de programación de robots explícito. Un sistema de programación 
de robots a nivel de tarea debe tener la habilidad de realizar muchas tareas de planea- 
ción automáticamente. Por ejemplo, si se emite una instrucción para “sujetar el perno”, 
el sistema debe planear una ruta que evite que el manipulador colisione con cualquier 
obstáculo circundante, elija automáticamente una buena posición de sujeción en el per¬ 
no y sujete el perno. En contraste, en un lenguaje de programación de robots explícito 
el programador debe hacer todas estas elecciones. 

Hay una buena distinción entre los lenguajes explícitos de programación de robots 
y los lenguajes de programación a nivel de tarea. Se están haciendo avances en los len¬ 
guajes explícitos de programación de robots para facilitar la programación, pero estas 
mejoras no pueden considerarse como componentes de un sistema de programación a ni¬ 
vel de tarea. Aún no existe la verdadera programación de manipuladores a nivel de ta¬ 
rea, pero desde hace tiempo es un tema de investigación [9,10] que continúa vigente. 

12.3 UN EJEMPLO DE APLICACIÓN 

La figura 12.2 muestra una célula de trabajo automatizada que completa un pequeño 
subensamblaje en un hipotético proceso de manufactura. La célula de trabajo consiste 
en un transportador bajo el control de una computadora que entrega una pieza de tra¬ 
bajo; una cámara conectada a un sistema de visión que se utiliza para localizar la pieza 
de trabajo en el transportador; un robot industrial (se muestra un PUMA 560) equipado 
con una muñeca detectora de fuerza; un pequeño alimentador ubicado en la superficie 
de trabajo que suministra otra pieza al manipulador; una prensa controlada por compu¬ 
tadora que puede ser cargada y descargada por el robot; y una tarima sobre la que el 
robot coloca los ensamblajes terminados. 

Todo el proceso está regulado por el controlador del manipulador en una secuen¬ 
cia, como se muestra a continuación: 

1. Se indica al transportador que arranque y se detiene cuando el sistema de visión 
reporta que se ha detectado un soporte en el transportador. 

2. El sistema de visión juzga la posición y la orientación del soporte en el transpor¬ 
tador y lo inspecciona para verificar que no haya defectos, como un número in¬ 
correcto de hoyos. 

3. Utilizando la salida del sistema de visión, el manipulador sujeta el soporte con 
una fuerza especificada y se verifica la distancia entre las puntas de los dedos pa¬ 
ra asegurar que el soporte se haya sujetado correctamente. En caso de algún 
error, el robot se hace a un lado y se repite la tarea de visión. 

4. El soporte se coloca en el dispositivo fijo de la superficie de trabajo. En este punto se 
puede indicar al transportador que arranque de nuevo para colocar el siguiente so¬ 
porte; esto es, los puntos 1 y 2 pueden empezar en paralelo con los siguientes pasos. 
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5. Se recoge una chaveta del alimentador y se inserta parcialmente en un hoyo có¬ 
nico en el soporte. Se utiliza el control de fuerza para realizar esta inserción y 
para realizar comprobaciones simples en cuanto a la terminación de esta tarea. 
(Si el alimentador de chavetas está vacío lo notifica a un operador y el manipu¬ 
lador espera hasta que el operador le ordene continuar). 

6. El robot sujeta el conjunto soporte-chaveta y lo coloca en la prensa. 

7. Se ordena a la prensa que actúe, y ésta presiona la chaveta completamente ha¬ 
cia dentro del soporte. La prensa indica que ha terminado y el soporte se colo¬ 
ca de nuevo en el dispositivo fijo para una inspección final. 

8. El conjunto se revisa con un sensor de fuerza para verificar que la chaveta esté 
insertada correctamente. El manipulador detecta la fuerza de reacción cuando 
presiona hacia los lados en la chaveta y puede hacer las comprobaciones nece¬ 
sarias para saber qué tan insertada está la chaveta en el soporte. 

9. Si el conjunto se encuentra en la posición correcta, el robot coloca la pieza termi¬ 
nada en la siguiente ubicación disponible en la tarima. Si está llena, se notifica al 
operador. Si el conjunto está mal ensamblado, se tira en el bote de basura. 

10. Una vez terminado el paso 2 (iniciado anteriormente en paralelo) se vuelve al 
paso 3. 

Este es un ejemplo de una tarea que es posible para los robots industriales de la 
actualidad. Debe quedar claro que tal vez no sea posible definir dicho proceso mediante 
las técnicas de “enseñar mostrando”. Por ejemplo, al tratar con tarimas es laborioso tener 
que programar todas las ubicaciones de todos los compartimentos; es preferible ense¬ 
ñar sólo la ubicación de la esquina y luego calcular las otras a partir de las dimensiones 
de la tarima. Además, por lo general es imposible especificar el señalamiento de inter¬ 
procesos y establecer el paralelismo mediante el uso de un dispositivo de enseñanza 
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típico o de una interfaz estilo menú. Este tipo de aplicación necesita un enfoque basa¬ 
do en el uso de un lenguaje de programación de robots para procesar la descripción. 
(Vea el ejercicio 12.5). Por otro lado, esta aplicación es demasiado compleja como para 
que cualquier lenguaje existente a nivel de tarea trate con ella directamente. Es co¬ 
mún que muchas excelentes aplicaciones se manejen con un método explícito de pro¬ 
gramación de robots. Tendremos el mismo ejemplo de aplicación en mente a medida 
que tratemos las características de los lenguajes de programación de robots. 

12.4 REQUERIMIENTOS DE UN LENGUAJE DE PROGRAMACIÓN DE ROBOTS 
Modelado del entorno 

Por definición, los programas de manipulación deben involucrar el movimiento de ob¬ 
jetos en espacio tridimensional, por lo que está claro que cualquier lenguaje de progra¬ 
mación de robots necesita un medio para describir dichas acciones. El elemento más 
común de los lenguajes de programación de robots es la existencia de tipos geométri¬ 
cos especiales. Por ejemplo, se introducen los tipos para representar conjuntos de án¬ 
gulos de articulación, posiciones cartesianas, orientaciones y tramas. A menudo hay 
operadores predefinidos disponibles que pueden manipular estos tipos. Las “tramas es¬ 
tándar” presentadas en el capítulo 3 podrían servir como un posible modelo del entor¬ 
no: todos los movimientos se describen como una trama herramienta relativa a una 
trama estación, en donde las tramas de destino se crean a partir de expresiones arbitra¬ 
rias que implican tipos geométricos. 

Dado un entorno de programación de robots que soporta tipos geométricos, el robot 
y las demás máquinas, piezas y dispositivos fijos pueden modelarse si definimos variables 
con nombre asociadas con cada objeto. La figura 12.3 muestra parte de nuestro ejemplo de 
célula de trabajo con tramas unidas en ubicaciones relevantes a la tarea. Cada una de estas 
tramas se representaría con una variable de tipo “trama” en el programa del robot. 



FIGURA 12.3: A menudo una célula de trabajo se modela en forma simple, como un 
conjunto de tramas unidas a objetos relevantes. 
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En muchos lenguajes de programación de robots, la habilidad para definir varia¬ 
bles con nombre de distintos tipos geométricos y hacer referencia a ellas en el progra¬ 
ma forma la base del modelo del entorno. Observe que las formas típicas de los objetos 
no son parte de dicho modelo del entorno, y tampoco los son las superficies, volúme¬ 
nes, masas u otras propiedades. La extensión en la que se modelan los objetos en el en¬ 
torno es una de las decisiones básicas al diseñar un sistema de programación de robots. 
La mayoría de los sistemas actuales soporta sólo el estilo que acabamos de describir. 

Ciertos sistemas de modelado de entornos permiten la noción de fijaciones entre 
objetos con nombre [3]; esto es, el sistema puede recibir una notificación de que se han 
“fijado” dos o más objetos con nombre; a partir de ese momento, si un objeto se mue¬ 
ve explícitamente con una instrucción del lenguaje, se moverán todos los objetos fija¬ 
dos a éste. Así, una vez que se ha insertado la chaveta en el agujero del soporte en 
nuestra aplicación, el sistema recibirá una notificación (mediante una instrucción del 
lenguaje) de que se han fijado estos dos objetos. Los movimientos subsiguientes del so¬ 
porte (es decir, los cambios en el valor de la variable de trama “soporte”) harán que el 
valor almacenado para la variable “chaveta” se actualice al mismo tiempo. 

Idealmente, un sistema de modelado de entornos incluiría mucha más información 
sobre los objetos con los que tiene que tratar el manipulador y sobre el manipulador en sí. 
Por ejemplo, considere un sistema en el que los objetos se describen mediante modelos es¬ 
tilo CAD que representan la forma espacial de cualquier objeto mediante las definiciones 
de sus bordes, sus superficies o su volumen. Con estos datos disponibles para el sistema, 
es más factible implementar muchas de las características de un sistema de programación 
a nivel de tarea. En el capítulo 13 hablaremos más sobre estas posibilidades. 

Especificación del movimiento 

Una función muy básica de un lenguaje de programación de robots es permitir la descrip¬ 
ción de los movimientos que se espera que realice. El usuario interactúa con los planea¬ 
dores de rutas y los generadores de estilo descritos en el capítulo 7 mediante instrucciones 
de movimiento que permiten especificar puntos vía, el punto de destino y si se va a utili¬ 
zar el movimiento interpolado de las articulaciones o en línea recta cartesiana. Además, el 
usuario podría tener el control sobre la velocidad o duración de un movimiento. 

Para ilustrar varias sintaxis para las primitivas del movimiento, consideraremos 
los siguientes movimientos de un manipulador como ejemplo: (1) moverse a la posición 
“destinol”; después (2) moverse en línea recta hasta la posición “destino2”; después (3) 
moverse, sin detenerse, a través de “vial” y detenerse completamente en “destino3”. 
Suponiendo que todos esos puntos de ruta ya se han enseñado o se han descrito tex¬ 
tualmente, este segmento de programa se escribiría así: 

En VAL II, 

move destinol 
move destino2 
move vial 
move destino3 

En AL (aquí se controla el manipulador “garm”), 

move garm to destinol; 

move garm to destino2 linearly; 

move garm to destino3 via vial; 
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La mayoría de los lenguajes tiene una sintaxis similar para instrucciones de movi¬ 
miento simples como éstas. Las diferencias en las primitivas de movimiento básico de 
un lenguaje de programación de robots a otro se hacen más aparentes si consideramos 
características como las siguientes: 

1. La habilidad para realizar matemáticas con tipos estructurados tales como tra¬ 
mas, vectores y matrices de rotación. 

2. La habilidad de describir entidades geométricas como tramas en varias represen¬ 
taciones convenientes; junto con la habilidad de realizar conversiones entre las 
representaciones. 

3. La habilidad de proporcionar restricciones sobre la duración o la velocidad de un 
movimiento específico; por ejemplo, muchos sistemas permiten al usuario esta¬ 
blecer la velocidad a una fracción del máximo, pero pocas le permiten especificar 
directamente una duración deseada o una velocidad de articulación máxima. 

4. La habilidad de especificar destinos en relación con varias tramas, incluyendo las 
tramas definidas por el usuario y las tramas en movimiento (en un transportador, 
por ejemplo). 

Flujo de ejecución 

Al igual que en los lenguajes convencionales de programación de computadoras, un siste¬ 
ma de programación de robots permite al usuario especificar el flujo de la ejecución; esto 
es, los conceptos tales como prueba y ramificación, ciclos, llamadas a subrutinas e incluso 
interrupciones se encuentran generalmente en los lenguajes de programación de robots. 

Más que en la mayoría de las aplicaciones computacionales, el procesamiento en 
paralelo es generalmente importante en aplicaciones de células de trabajo automatiza¬ 
das. En primer lugar, es muy común que dos o más robots se utilicen en una sola célu¬ 
la de trabajo y que trabajen de manera simultánea para reducir el tiempo de ciclo del 
proceso. Incluso en las aplicaciones de un solo robot, como la que se muestra en la fi¬ 
gura 12.2, el controlador del robot debe controlar otro equipo de la célula de trabajo 
en forma paralela. Por ende, a menudo se encuentran las primitivas señal y espera en 
los lenguajes de programación de robots, y ocasionalmente se proporcionan construc¬ 
ciones de ejecución en paralelo más sofisticadas [3]. 

Otro hecho frecuente es la necesidad de monitorear varios procesos con algún ti¬ 
po de sensor. Después, ya sea mediante la interrupción o el sondeo, el sistema de robot 
debe ser capaz de responder a ciertos eventos detectados por los sensores. La habilidad de 
especificar dichos monitores de eventos es soportada por algunos lenguajes de progra¬ 
mación de robots [2, 3]. 

Entorno de programación 

Al igual que con cualquier lenguaje computacional, un buen entorno de programación 
fomenta la productividad del programador. La programación de manipuladores es di¬ 
fícil y tiende a ser muy interactiva, con muchas sesiones de prueba y error. Si se obligara 
al usuario a repetir continuamente el ciclo de “editar-compilar-ejecutar” de los lengua¬ 
jes compilados, la productividad sería baja. Por lo tanto, la mayoría de los lenguajes de 
programación ahora son interpretados, de manera que las instrucciones individuales 
puedan ejecutarse de una en una durante el desarrollo y la depuración del programa. 
Muchas de las instrucciones de un lenguaje ocasionan el movimiento de un dispositivo 
físico, por lo que la pequeña cantidad de tiempo requerido para interpretar las instruc¬ 
ciones del lenguaje es insignificante. También se requiere el soporte típico de progra¬ 
mación: editores de texto, depuradores y un sistema de archivos. 
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Integración de sensores 

Una parte extremadamente importante de la programación de robots tiene que ver con 
la interacción con sensores. El sistema debe tener, como mínimo, la capacidad de con¬ 
sultar sensores de tacto y fuerza, y de utilizar la respuesta en instrucciones “if-then-el- 
se” (si-entonces). La habilidad de especificar monitores de eventos para vigilar las 
transiciones en dichos sensores en un modo de segundo plano es también muy útil. 

La integración con un sistema de visión permite que el sistema de visión envíe al sis¬ 
tema manipulador las coordenadas de un objeto de interés. Por ejemplo, en nuestra apli¬ 
cación de ejemplo, un sistema de visión ubica los soportes en la banda transportadora y 
regresa al controlador del manipulador su posición y orientación relativas a la cámara. Se 
conoce la trama de la cámara relativa a la trama estación, por lo que puede calcularse una 
trama de destino deseada para el manipulador a partir de esta información. 

Algunos sensores podrían ser parte de otro equipo en la célula de trabajo; por ejem¬ 
plo, algunos controladores de robot pueden utilizar la entrada proveniente de un sensor 
unido a una banda transportadora, de manera que el manipulador pueda rastrear el mo¬ 
vimiento de la banda y adquirir objetos de ésta a medida que se va moviendo [2], 

La interfaz para las capacidades de control de fuerza, como se vio en el capítulo 9, 
se da a través de instrucciones especiales del lenguaje que permiten al usuario especificar 
estrategias de fuerza [3]. Dichas estrategias son, por necesidad, una parte integrada del sis¬ 
tema de control del manipulador; el lenguaje de programación de robots simplemente sir¬ 
ve como interfaz para esas capacidades. Para programar robots que hagan uso del control 
de fuerza activo se podrían requerir otras características especiales, tales como la habili¬ 
dad de mostrar datos de fuerza recolectados durante un movimiento restringido [3]. 

En sistemas que soportan el control de fuerza activo, la descripción de la aplica¬ 
ción de fuerza deseada podría convertirse en parte de la especificación del movimiento. 
El lenguaje AL describe el control de fuerza activo en las primitivas de movimiento, es¬ 
pecificando seis componentes de rigidez (tres de traslación y tres de rotación) y una 
fuerza de desvío. De esta manera, la rigidez aparente del manipulador es programable. 
Para aplicar una fuerza, por lo general la rigidez se hace cero en esa dirección y se es¬ 
pecifica una fuerza de desvío; por ejemplo, 

move garm to destino 

with stiffness=(80, 80, 0, 100, 100, 100) 
with force=20*ounces along zhat; 

12.5 PROBLEMAS PECULIARES PARA LOS LENGUAJES DE PROGRAMACIÓN DE ROBOTS 

Los avances en años recientes han ayudado, pero aún es difícil programar robots. La 
programación de robots comparte todos los problemas de la programación convencio¬ 
nal de computadoras, más ciertas dificultades adicionales ocasionadas por los efectos 
del mundo físico [12]. 

Comparación entre el modelo del entorno y la realidad externa 

Una característica central de un sistema de programación de robots es el modelo del 
entorno que se mantiene internamente en la computadora. Aun y cuando este modelo 
es considerablemente simple, hay grandes dificultades para asegurar que concuerde 
con la realidad física que trata de modelar. Las discrepancias entre el modelo interno y 
la realidad externa hacen que los objetos se sujeten mal o no se sujeten, produzcan co¬ 
lisiones y otros problemas más sutiles. 
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Esta correspondencia entre el modelo interno y el externo debe establecerse para 
el estado inicial del programa, y debe mantenerse durante su ejecución. Durante la pro¬ 
gramación inicial o la depuración es generalmente responsabilidad del usuario asegurar¬ 
se que el estado representado en el programa corresponda con el estado físico de la célula 
de trabajo. A diferencia de la programación más convencional, en donde sólo necesitan 
guardarse variables internas y restaurarse para restablecer una situación previa, en la 
programación de robots los objetos físicos comúnmente deben reposicionarse. 

Además de la incertidumbre inherente en la posición de cada objeto, el manipu¬ 
lador en sí está limitado a un cierto grado de precisión. Muy a menudo los pasos en el 
ensamblaje requieren que el manipulador haga movimientos que requieren mayor pre¬ 
cisión de la que es capaz; un ejemplo común es insertar una chaveta en un hoyo en el 
que el espacio libre es de una magnitud menor que la precisión posicional del manipu¬ 
lador. Para complicar más las cosas, la precisión del manipulador generalmente varía 
sobre su espacio de trabajo. 

Al tratar con esos objetos cuyas ubicaciones no se conocen exactamente, es esen¬ 
cial retinar de alguna forma la información posicional. Esto puede hacerse algunas ve¬ 
ces con sensores (por ejemplo, de visión, de tacto) o utilizando estrategias de fuerza 
apropiadas para los movimientos restringidos. 

Durante la depuración de los programas del manipulador, es muy útil poder mo¬ 
dificar el programa y después respaldar y probar un procedimiento otra vez. Para 
respaldar hay que restaurar el manipulador y los objetos que se están manipulando a 
un estado anterior. No obstante, al trabajar con objetos físicos no siempre es fácil, o in¬ 
cluso posible, deshacer una acción. Algunos ejemplos son las operaciones de pintura, 
remachado, perforación o soldadura, que producen una modificación física de los ob¬ 
jetos que se están manipulando. Por lo tanto, podría requerirse que el usuario obtenga 
una nueva copia del objeto para reemplazar el anterior que se ha modificado. Además, 
es probable que algunas de las operaciones realizadas justo antes de la que se va a rein¬ 
tentar también necesiten repetirse para establecer el estado apropiado requerido antes 
de que pueda reintentarse con éxito la operación deseada. 

Sensibilidad al contexto 

La programación ascendente (bottom-up programming ) es un método estándar para 
escribir un programa computacional extenso en el que se desarrollan pequeñas pie¬ 
zas de bajo nivel de un programa y luego se juntan en piezas más grandes, formando un 
programa completo. Para que este método funcione es esencial que las piezas pequeñas 
sean relativamente insensibles a las instrucciones del lenguaje que las precede y que no 
haya suposiciones con relación al contexto en el que se ejecutan. Para la programación 
de manipuladores éste no es comúnmente el caso; el código que trabajaba confiable¬ 
mente al probarse aislado con frecuencia falla cuando se coloca dentro del contexto de 
un programa más grande. Estos problemas generalmente surgen de las dependencias 
en la configuración del manipulador y la velocidad de los movimientos. 

Los programas de manipuladores pueden ser altamente sensibles a las condiciones 
iniciales; por ejemplo, la posición inicial del manipulador. En trayectorias de movimien¬ 
to la posición inicial podría también influenciar la velocidad con la que se moverá el 
brazo durante cierta parte crítica del movimiento. Por ejemplo, estas aseveraciones se 
cumplen para los manipuladores que siguen las rutas del tipo trazador cúbico en el espa¬ 
cio de articulación que estudiamos en el capítulo 7. Estos efectos pueden algunas veces 
tratarse mediante un cuidado apropiado en la programación, pero a menudo dichos 
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problemas no surgen sino hasta después que se han depurado en forma aislada las decla¬ 
raciones iniciales del lenguaje y luego se unen con las instrucciones que las preceden. 

Debido a una precisión insuficiente del manipulador, es muy probable que un seg¬ 
mento de programa escrito para realizar una operación en cierta ubicación necesite 
ajustarse (es decir, volver a enseñar las posiciones, etcétera) para hacerlo que funcione 
en una ubicación distinta. Los cambios de ubicación dentro de la célula de trabajo pro¬ 
ducen cambios en la configuración del manipulador para llegar a las ubicaciones de des¬ 
tino. Dichos intentos de reubicar los movimientos del manipulador dentro de la célula 
de trabajo ponen a prueba la precisión de los comportamientos cinemáticos del manipu¬ 
lador y del sistema de servo, y con frecuencia surgen problemas. Dicha reubicación po¬ 
dría provocar un cambio en la configuración cinemática del manipulador; por ejemplo, 
del hombro izquierdo al hombro derecho, o del codo hacia arriba al codo hacia abajo. Lo 
que es más, estos cambios en la configuración podrían ocasionar grandes movimientos 
del brazo durante lo que había sido previamente un movimiento corto y simple. 

Es muy probable que la naturaleza de la forma espacial de las trayectorias cam¬ 
bie a medida que se ubican las rutas en distintas porciones del espacio de trabajo del 
manipulador. Esto es especialmente cierto para los métodos de trayectorias en espacio 
de articulación, pero el uso de los esquemas de ruta cartesiana también puede produ¬ 
cir problemas cuando hay singularidades cerca. 

Al probar el movimiento de un manipulador por primera vez, a menudo es conve¬ 
niente hacer que el manipulador se mueva lentamente. Esto da al usuario la oportunidad 
de detener el movimiento si parece estar a punto de provocar una colisión; también le per¬ 
mite inspeccionar el movimiento muy de cerca. Una vez que el movimiento ha pasado por 
cierta depuración inicial a una velocidad menor, es conveniente aumentar las velocidades 
del movimiento. Al hacer esto algunos aspectos del movimiento podrían cambiar. Las li¬ 
mitaciones en la mayoría de los sistemas de control de manipuladores producen errores de 
servo mayores, los cuales son de esperarse si se sigue la trayectoria más rápida. Además, 
en situaciones de control de fuerza que impliquen un contacto con el entorno, los cambios 
de velocidad pueden modificar completamente las estrategias de fuerza requeridas. 

La configuración del manipulador también afecta la delicadeza y precisión de las 
fuerzas que pueden aplicarse con él. Esta es una función de qué tan bien condicionado 
está el jacobiano del manipulador en cierta configuración, algo generalmente difícil de 
considerar al desarrollar programas para robots. 

Recuperación de errores 

Otra consecuencia directa de trabajar con el mundo físico es que los objetos podrían no 
encontrarse exactamente en donde deberían y, por lo tanto, los movimientos que se 
realizan con esos objetos podrían fallar. Parte de la programación de manipuladores 
implica el tratar de tomar esto en cuenta y hacer las operaciones de ensamblaje lo más 
robustas que sea posible pero, aún así, es probable que haya errores, y un aspecto im¬ 
portante de la programación de manipuladores es cómo recuperarse de estos errores. 

Casi cualquier instrucción de movimiento en el programa del usuario puede fa¬ 
llar, por una gran variedad de razones. Algunas de las causas más comunes son que los 
objetos se desplacen o se resbalen de la mano, que un objeto no se encuentre en don¬ 
de debería estar, que se atasque el objeto durante una inserción y que no se pueda lo¬ 
calizar un hoyo. 

El primer problema que surge para la recuperación de errores es identificar que 
efectivamente haya ocurrido un error. Como los robots generalmente tienen capacidades 
de detección y razonamiento bastante limitadas, a menudo la detección de errores es 
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difícil. Para poder detectar un error, un programa de robot debe contener cierto tipo de 
prueba explícita. Esta prueba podría implicar el comprobar la posición del manipula¬ 
dor para ver que se encuentre en el rango apropiado; por ejemplo, cuando se realiza 
una inserción, la falta de cambio de posición podría indicar un atascamiento, o dema¬ 
siado cambio podría indicar que no se pudo localizar el hoyo o que el objeto se res¬ 
baló de la mano. Si el sistema de manipulador cuenta con cierto tipo de capacidades 
visuales, entonces podría tomar una foto y revisar la presencia o ausencia de un objeto 
y, si el objeto está presente, reportar su ubicación. Otras comprobaciones podrían im¬ 
plicar el uso de fuerza, como pesar la carga que se lleva para revisar que el objeto aún 
esté allí y no se haya caído, o revisar que una fuerza de contacto permanezca dentro de 
ciertos límites durante un movimiento. 

Todas las instrucciones de movimiento en el programa podrían fallar, por lo que 
estas comprobaciones explícitas pueden ser bastante complicadas y pueden ocupar más 
espacio que el resto del programa. Es en extremo difícil tratar de lidiar con todos los 
posibles errores; generalmente sólo se comprueban las instrucciones con más probabi¬ 
lidad de fallar; y este proceso requiere de cierta cantidad de interacción y prueba par¬ 
cial con el robot durante la etapa de desarrollo del programa. 

Una vez que se ha detectado un error, puede hacerse un intento por recuperarse 
del mismo; el manipulador puede hacerlo bajo el control del programa o tal vez el usua¬ 
rio tenga que intervenir, o podría requerirse cierta combinación de las dos cosas. En 
cualquier caso el intento de recuperación podría producir nuevos errores. Es fácil ver 
cómo el código para recuperarse de los errores puede convertirse en la parte principal 
del programa del manipulador. 

El uso del paralelismo en los programas de manipuladores puede complicar aún 
más la recuperación después de errores. Cuando varios procesos se ejecutan concurren¬ 
temente y uno de ellos provoca un error, podría afectar otros procesos. En muchos ca¬ 
sos es posible hacer retroceder el proceso que provoca el error, permitiendo a los otros 
continuar. Otras veces es necesario reiniciar varios o todos los procesos en ejecución. 
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EJERCICIOS 

12.1 [15] Escriba un programa de robot (en el lenguaje de su elección) para recoger un 
bloque de la ubicación A y colocarlo en la ubicación B. 

12.2 [20] Con simples comandos en español, que podrían formar la base de un programa 
de robot, describa cómo atar las agujetas de sus zapatos. 

12.3 [32] Diseñe la sintaxis de un nuevo lenguaje de programación de robots. Incluya for¬ 
mas de proporcionar la duración o las velocidades de las trayectorias de movimien¬ 
to, haga instrucciones de E/S para los periféricos, proporcione comandos para 
controlar la pinza de sujeción y produzca comandos de detección de fuerza (es decir, 
de movimiento protegido). Puede omitir el control de fuerza y el paralelismo. 

12.4 [28] Extienda la especificación del nuevo lenguaje de programación de robots que 
inició en el ejercicio 12.3, agregando la sintaxis para el control de fuerza y para el pa¬ 
ralelismo. 

12.5 [38] Escriba un programa, en un lenguaje de programación de robots que esté co¬ 
mercialmente disponible, para realizar la aplicación descrita en la sección 12.3. Ha¬ 
ga todas las suposiciones razonables en relación con las conexiones de E/S y otros 
detalles. 

12.6 [28] Utilizando cualquier lenguaje de robots, escriba una rutina general para descar¬ 
gar una tarima de tamaño arbitrario. La rutina deberá mantener un registro de indi- 
zación a través de la tarima y deberá indicar a un operador humano cuando ésta se 
encuentre vacía. Suponga que las piezas se descargan en una banda transportadora. 

12.7 [35] Usando cualquier lenguaje de robot, escriba una rutina general para descargar 
una tarima fuente de tamaño arbitrario, y para cargar una tarima destino de tamaño 
arbitrario. La rutina deberá llevar el registro de indización a través de las tarimas y 
deberá indicar a un operador humano cuando la tarima fuente esté vacía y cuando 
la tarima destino esté llena. 

12.8 [35] Usando cualquier lenguaje de programación de robots que sea capaz de reali¬ 
zarlo, escriba un programa que emplee el control de fuerza para llenar una cajetilla 
con 20 cigarrillos. Suponga que el manipulador tiene una precisión de aproximada¬ 
mente 0.25 pulgadas, por lo que deberá usarse el control de fuerza para muchas ope¬ 
raciones. Los cigarrillos se presentan en una banda transportadora, y un sistema de 
visión devuelve sus coordenadas. 

12.9 [35] Usando cualquier lenguaje de programación de robots capaz de llevarlo a cabo, 
escriba un programa para ensamblar la porción portátil de un teléfono estándar. Los 
seis componentes (auricular, micrófono, bocina, dos tapas y un cable) llegan en un 
kit, esto es, una tarima especial que sostiene una pieza de cada componente. Supon¬ 
ga que hay un dispositivo fijo en el que puede colocarse el auricular para que lo sos¬ 
tenga. Haga todas las demás suposiciones necesarias. 


352 


Capítulo 12 


Lenguajes y sistemas de programación de robots 


12.10 [33] Escriba un programa de robot que utilice dos manipuladores. Uno, llamado 
GARM, tiene un efector final especial diseñado para sostener una botella de vino. 
El otro brazo, llamado BARM, sostendrá una copa de vino y está equipado con una 
muñeca detectora de fuerza que puede usarse para indicar a GARM que deje de ver¬ 
ter cuando detecte que la copa está llena. 

EJERCICIO DE PROGRAMACIÓN (PARTE 12) 

Cree una interfaz de usuario para los demás programas que ha desarrollado, escribiendo 
unas cuantas subrutinas en Pascal. Una vez definidas estas subrutinas, un “usuario” podría 
escribir un programa en Pascal que contenga llamadas a estas subrutinas, para realizar la si¬ 
mulación de una aplicación de robot en 2-D. 

Defina primitivas que permitan al usuario ajustar las tramas estación y herramienta; 
a saber, 

ajustarestacion(SrelB:vec3); 
ajustarherramienta(TrelW:vec3); 

en donde “SrelB” indica la trama estación relativa a la trama base del robot y “TrelW” de¬ 
fine la trama herramienta relativa a la trama muñeca del manipulador. Defina las primitivas 
de movimiento 

moveto(destino:vec3); 
moveto(incremento:vec3); 

donde “destino” es una especificación de la trama de destino relativa a la trama estación, e 
“incremento” es una especificación de la trama de destino relativa a la trama herramienta 
actual. Permita la descripción de rutas multisegmento cuando el usuario llame primero a la 
función “pathmode”, luego especifique movimientos a los puntos vía, y finalmente diga 
“runpath”; por ejemplo, 

pathmode; (* entrar en el modo ruta *) 
moveto(destino1); 
moveto(destino2); 

runpath; (* ejecutar la ruta sin detenerse en el destinol *) 

Escriba un simple programa de “aplicación” y haga que su sistema imprima la ubicación del 
brazo cada n segundos. 
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13.1 INTRODUCCIÓN 

Definiremos un sistema de programación fuera de línea (OLP, por sus siglas en inglés) 
como un lenguaje de programación que se ha extendido lo suficiente, generalmente 
mediante gráficos computacionales, como para que el desarrollo de programas de ro¬ 
bot pueda llevarse a cabo sin necesidad de tener acceso al mismo robot. 1 Los sistemas 
de programación fuera de línea son importantes como ayuda en la programación de la 
automatización industrial contemporánea, y también como plataformas de investiga¬ 
ción robótica. Hay que considerar muchas cuestiones en el diseño de dichos sistemas. 
En este capítulo presentaremos primero una discusión sobre estas cuestiones [1] y des¬ 
pués veremos más de cerca un sistema de este tipo [2]. 

Durante los últimos 20 años, el crecimiento del mercado de robots industriales no ha 
sido tan rápido como una vez se pronosticó; una de las principales razones es que los robots 
aún son muy difíciles de utilizar. Se requiere de gran cantidad de tiempo y experiencia pa¬ 
ra instalar un robot en una aplicación específica y hacer que el sistema esté listo para la pro¬ 
ducción. Por varias razones, este problema es más severo en algunas aplicaciones que en 
otras; por lo tanto, vemos que ciertas áreas (por ejemplo, la soldadura por punto y la pin¬ 
tura con pistola de aire) se están automatizando con robots mucho más pronto que otros 
dominios de aplicación (por ejemplo, el ensamblaje). Parece que la falta de implementado- 
res de sistemas de robots con suficiente capacitación está limitando el crecimiento en algu¬ 
nas áreas de aplicación (si no es que en todas). En ciertas compañías de fabricación, la 
gerencia alienta el uso de robots a un nivel mayor que el que pueden realizar los ingenie¬ 
ros de aplicaciones. Además, un gran porcentaje de los robots entregados se están usando 
en formas que no aprovechan completamente sus capacidades. Estos síntomas indican que 
los robots industriales de la actualidad no son lo suficientemente fáciles de usar como para 
permitir que se instalen y se programen con éxito en forma oportuna. 

Muchos factores hacen que la programación de robots sea una tarea difícil. En 
primer lugar está relacionada intrínsecamente con la programación de computadoras 
en general y, por lo tanto, comparte muchos de los problemas de ese campo; pero la 
programación de robots, o de cualquier máquina programable, tiene problemas específicos 


1 El capítulo 13 es una versión editada de dos artículos: uno reimpreso con permiso de International Sym- 
posium of Robotics Research, R. Bolles y B. Roth (editores), 1988 (ref [1]); el otro de Robotics: The Algo- 
rithmic Perspective, P. Agarwal y otros (editores), 1998 (ref [2]). 
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que hacen que el desarrollo de software listo para la producción sea aún más difícil. Co¬ 
mo vimos en el capítulo anterior, la mayor parte de estos problemas surgen del hecho de 
que un manipulador de robot interactúa con su entorno físico [3]. Incluso hasta los siste¬ 
mas de programación simples mantienen un “modelo global” de este entorno físico en la 
forma de ubicaciones de objetos, y tienen “conocimiento” de la presencia y ausencia de 
varios objetos codificados en las estrategias del programa. Durante el desarrollo de un 
programa de robot (y especialmente después, durante su uso en la producción), es nece¬ 
sario que el sistema de programación mantenga el modelo interno en correspondencia 
con el estado actual del entorno del robot. La depuración interactiva de programas con 
un manipulador requiere reiniciar frecuentemente el estado del entorno del robot; las 
piezas, las herramientas y demás objetos necesitan regresarse a sus posiciones iniciales. 
Este proceso de reiniciar el estado se vuelve especialmente difícil (y algunas veces costo¬ 
so) cuando el robot realiza una operación irreversible en una o más piezas (por ejemplo, 
perforación o enrutamiento). El efecto más espectacular de la presencia del entorno físico 
es cuando un error del programa se manifiesta en cierta operación irreversible no inten¬ 
cional sobre las piezas, las herramientas o incluso sobre el mismo manipulador. 

Aunque existen dificultades para mantener un modelo interno preciso del entorno 
del manipulador, parece que no hay duda de que se generan grandes beneficios. Áreas 
completas de investigación de sensores (tal vez la más notable sea la visión por compu¬ 
tadora) se enfocan en desarrollar técnicas mediante las cuales se puedan verificar, corre¬ 
gir o descubrir los modelos del entorno. Evidentemente, para poder aplicar cualquier 
algoritmo computacional al problema de generación de comandos para robot, el algorit¬ 
mo necesita acceso a un modelo del robot y de su entorno. 

En el desarrollo de sistemas de programación para robots, los avances en el poder 
de las técnicas de programación parecen estar directamente vinculados con la sofistica¬ 
ción del modelo interno al que hace referencia el lenguaje de programación. Los primeros 
sistemas de robots operando en el espacio de articulación, del tipo “enseñar mostrando”, 
empleaban un modelo limitado del mundo, por lo que había maneras muy limitadas en 
las que el sistema podía ayudar al programador a lograr una tarea. Los controladores de 
robot ligeramente más sofisticados incluían modelos cinemáticos, de manera que el siste¬ 
ma podía cuando menos ayudar al usuario a mover las articulaciones para lograr movi¬ 
mientos cartesianos. Los lenguajes de programación de robots (RPL) evolucionaron para 
soportar muchos tipos de datos y operaciones distintos, que el programador puede utili¬ 
za según necesite, para modelar los atributos del entorno y calcular acciones para el ro¬ 
bot. Algunos RPL soportan primitivas de modelado del entorno tales como fijaciones, 
tipos de datos para fuerzas y momentos, y otras características [4], 

Los actuales lenguajes de programación de robots podrían llamarse “lenguajes de 
programación explícitos”, ya que el ingeniero de aplicación debe programar cada ac¬ 
ción que realiza el sistema. Del otro lado del espectro están los llamados sistemas de 
programación a nivel de tarea (TLP), en los que el programador puede declarar obje¬ 
tivos de alto nivel tales como “insertar el perno” o tal vez hasta “fabricar el horno tos¬ 
tador”. Estos sistemas utilizan técnicas de la investigación en inteligencia artificial para 
generar planes de movimiento y estrategia de manera automática. No obstante, los len¬ 
guajes a nivel de tarea así de sofisticados no existen todavía; varias piezas de dichos sis¬ 
temas se encuentran actualmente en desarrollo por parte de los investigadores [5]. Los 
sistemas de programación a nivel de tarea requieren un modelo muy completo del ro¬ 
bot y de su entorno para realizar las operaciones de planeación automatizadas. 

Aunque este capítulo se enfoca hasta cierto punto en el problema específico de la 
programación de robots, la noción de un sistema OLP se extiende a cualquier dispositivo 
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programable en la fábrica. Un argumento que surge comúnmente en favor es que un 
sistema OLP no acapara el equipo de producción cuando necesita reprogramarse; por 
ende, las fábricas automatizadas pueden permanecer en modo de producción un mayor 
porcentaje del tiempo. También sirven como un vehículo natural para enlazar las bases 
de datos de diseño asistido por computadora (CAD) que se utilizan en la fase de dise¬ 
ño del desarrollo de un producto con la fabricación del mismo. En ciertas aplicaciones, 
el uso directo de datos de diseño CAD puede reducir considerablemente el tiempo de 
programación requerido para la maquinaria de fabricación. 

La programación de robots fuera de línea ofrece otros beneficios potenciales, de 
los cuales algunos ya están siendo apreciados por los usuarios de robots industriales. 
Hemos hablado sobre algunos de los problemas asociados con la programación de 
robots, y la mayoría tienen que ver con el hecho de que una célula de trabajo física ex¬ 
terna está siendo manipulada por el programa del robot. Esto hace que el proceso de 
retroceder para probar distintas estrategias sea tedioso. La programación de robots en 
simulación ofrece una manera de mantener todo lo relacionado con el trabajo de pro¬ 
gramación de una manera estrictamente interna en una computadora hasta que la apli¬ 
cación esté casi completa. Con este enfoque, muchos de los problemas peculiares de la 
programación de robots tienden a desaparecer. 

Los sistemas de programación fuera de línea deberían servir como ruta de creci¬ 
miento natural de los sistemas de programación explícitos a los sistemas de programación 
a nivel de tarea. El sistema OLP más simple es sólo una extensión gráfica para un len¬ 
guaje de programación de robots, pero de ahí puede extenderse hacia un sistema de pro¬ 
gramación a nivel de tarea. Esta extensión gradual se logra proporcionando soluciones 
automatizadas a varias subtareas (a medida que estas soluciones estén disponibles) y de¬ 
jando que el usuario las utilice para explorar opciones en el entorno simulado. Hasta que 
descubramos cómo construir sistemas a nivel de tarea, el usuario deberá permanecer en 
el ciclo para evaluar subtareas planeadas automáticamente y guiar el desarrollo del pro¬ 
grama de aplicación. Si tomamos este enfoque, un sistema OLP sirve como una base im¬ 
portante para la investigación y el desarrollo de sistemas de planeación a nivel de tarea 
y, evidentemente, para apoyar su trabajo muchos investigadores han desarrollado varios 
componentes de un sistema OLP (por ejemplo, modelos en 3-D y pantallas gráficas, pos¬ 
procesadores de lenguaje). En consecuencia, los sistemas OLP deberían ser una herra¬ 
mienta útil en la investigación, así como una ayuda en la práctica industrial actual. 

13.2 CUESTIONES BÁSICAS DE LOS SISTEMAS OLP 

Esta sección trata sobre muchos de los puntos que deben considerarse en el diseño de 
un sistema OLE La colección de temas descritos le ayudará a establecer el alcance de la 
definición de un sistema OLP. 

Interfaz de usuario 

Una motivación importante para desarrollar un sistema OLP es crear un entorno que 
facilite la programación de manipuladores, por lo que la interfaz de usuario es de cru¬ 
cial importancia. Sin embargo, otra de las principales motivaciones es eliminar la de¬ 
pendencia en el uso del equipo físico durante la programación. En una consideración 
inicial, estas dos metas parecen estar en conflicto; los robots ya son bastante difíciles de 
programar cuando se les tiene enfrente, así que ¿cómo puede ser más fácil sin la pre¬ 
sencia del dispositivo físico? Esta pregunta toca la esencia del problema de diseño de 
sistemas OLP. 
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Los fabricantes de robots industriales han aprendido que un gran porcentaje del 
personal de manufactura no puede utilizar correctamente los RPL que proveen con sus 
robots. Por ésta y otras razones históricas, muchos robots industriales vienen equipa¬ 
dos con una interfaz de dos niveles [6], una para programadores y otra para no progra¬ 
madores. Los no programadores utilizan un dispositivo de enseñanza e interactúan 
directamente con el robot para desarrollar los programas. Los programadores escriben 
código en el RPL e interactúan con el robot para poder enseñarle los puntos de traba¬ 
jo y depurar el flujo del programa. En general, estos dos enfoques para el desarrollo de 
programas intercambian la facilidad de uso por la flexibilidad. 

Cuando se ve como una extensión de un RPL, un sistema OLP contiene por na¬ 
turaleza un RPL como subconjunto de su interfaz de usuario. Este RPL debe proveer 
características que se consideren valiosas en los sistemas de programación de robots. 
Por ejemplo, para usarse como un RPL, los lenguajes interactivos son mucho más pro¬ 
ductivos que los compilados, los cuales obligan al usuario a pasar por el ciclo de “edi- 
tar-compilar-ejecutar” en cada modificación del programa. 

La porción de la interfaz de usuario correspondiente al lenguaje hereda mucho de 
los RPL “tradicionales”; es la interfaz de nivel más bajo (es decir, más fácil de usar) que 
debe considerarse cuidadosamente en un sistema OLP. Un componente central de es¬ 
ta interfaz es una vista de gráficos computacionales del robot que se está programando 
y de su entorno. Utilizando un dispositivo señalador tal como un ratón, el usuario pue¬ 
de indicar varias ubicaciones u objetos en la pantalla de gráficos. El diseño de la inter¬ 
faz de usuario controla exactamente la forma en que el usuario interactúa con la 
pantalla para especificar un programa de robot. El mismo dispositivo señalador puede 
indicar elementos en un “menú” para poder invocar varias funciones. 

Una primitiva central es la de enseñar a un robot un punto de trabajo o “trama” que 
tenga seis grados de libertad por medio de la interacción con la pantalla de gráficos. La dis¬ 
ponibilidad de modelos 3-D de los dispositivos fijos y las piezas de trabajo en el sistema 
OLP facilita esta tarea considerablemente. La interfaz provee al usuario con los medios pa¬ 
ra indicar las ubicaciones en las superficies, permitiendo que la orientación de la trama to¬ 
me una normal a la superficie local, y luego proporciona métodos para desplazar, reorientar 
y así sucesivamente. Dependiendo de los detalles específicos de la aplicación, dichas tareas 
se especifican muy fácilmente mediante la ventana de gráficos en el mundo simulado. 

Una interfaz de usuario bien diseñada debe permitir a los no programadores lle¬ 
var a cabo muchas aplicaciones de principio a fin. Además, el sistema OLP debe tener 
la capacidad de traducir las tramas y las secuencias de movimiento “enseñadas” por los 
no programadores en instrucciones textuales del RPL. Estos programas simples pue¬ 
den mantenerse y embellecerse en formato de RPL por programadores más experi¬ 
mentados. Para los programadores, la disponibilidad del RPL permite el desarrollo de 
código arbitrario para aplicaciones más complejas. 

Modelado en 3-D 

Un elemento central en los sistemas OLP es el uso de descripciones gráficas del robot 
simulado y su célula de trabajo. Para ello se requiere que el robot y todos los dispositivos 
fijos, piezas y herramientas en la célula de trabajo se modelen como objetos tridimensio¬ 
nales. Para agilizar el desarrollo del programa, es conveniente utilizar modelos CAD de 
piezas o herramientas que estén directamente disponibles desde el sistema CAD en el 
que se haya realizado el diseño original. A medida que prevalezcan cada vez más los sis¬ 
temas CAD en la industria, será más probable que este tipo de datos geométricos esté 
disponible y listo para usarse. Debido al urgente deseo de tener este tipo de integración 
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CAD del diseño a la producción, tiene sentido que un sistema OLP contenga un sub¬ 
sistema de modelado CAD o que sea, en sí, una parte de un sistema de diseño de este 
tipo. Si un sistema OLP va a ser autónomo, debe tener las interfaces apropiadas para 
transferir modelos desde y hacia sistemas CAD externos; no obstante, hasta un sistema 
OLP autónomo debería tener cuando menos una simple instalación CAD local para crear 
rápidamente modelos de elementos no críticos de la célula de trabajo, o para agregar da¬ 
tos específicos del robot a los modelos CAD importados. 

Los sistemas OLP por lo común requieren de varias representaciones de formas 
espaciales. Para muchas operaciones, generalmente existe una descripción analítica 
exacta de la superficie o volumen; aún así, para poder beneficiarse de la tecnología de 
visualización a menudo se requiere otra representación. La tecnología actual está bien 
adaptada a los sistemas en los que la primitiva de visualización subyacente es un polí¬ 
gono plano; sin embargo, aunque la forma de un objeto pueda estar bien representada 
por una superficie uniforme, la visualización práctica (especialmente para la anima¬ 
ción) requiere una representación por facetas. Las acciones gráficas de la interfaz de 
usuario, como señalar un punto en una superficie, deberían actuar internamente de ma¬ 
nera que se especifique un punto en la superficie real, incluso si gráficamente el usua¬ 
rio vea una descripción del modelo por facetas. 

Un uso importante de la geometría tridimensional de los modelos de objetos es 
para la detección automática de colisiones; esto es, cuando ocurre una colisión entre los 
objetos en un entorno simulado, el sistema OLP debería advertir automáticamente al 
usuario e indicarle exactamente en dónde ocurrió la colisión. Aplicaciones como el en¬ 
samblaje pueden implicar muchas “colisiones” deseadas, por lo que es necesario poder 
informar al sistema que las colisiones entre ciertos objetos son aceptables. También es 
importante poder generar una advertencia de colisión cuando los objetos pasan dentro 
de una tolerancia especificada de una verdadera colisión. En la actualidad es difícil de¬ 
tectar con exactitud las colisiones para sólidos generales en 3-D, pero la detección de 
colisiones para modelos por facetas es bastante práctica. 

Emulación cinemática 

Un componente imprescindible para mantener la validez del mundo simulado es la emu¬ 
lación fiel de los aspectos geométricos de cada manipulador simulado. Respecto a la ci¬ 
nemática inversa, el sistema OLP puede interactuar con el controlador de robot en dos 
formas distintas. En primer lugar, el sistema OLP podría sustituir la cinemática inversa 
del controlador de robot y siempre comunicar las posiciones de éste en el espacio de ar¬ 
ticulación del mecanismo. La segunda opción es comunicar las ubicaciones cartesianas al 
controlador de robot y dejar que el controlador utilice la cinemática inversa suministrada 
por el fabricante para resolver las configuraciones del robot. Casi siempre es preferible 
usar la segunda opción, sobre todo porque los fabricantes están empezando a construir 
una calibración estilo rastro del brazo en sus robots. Estas técnicas de calibración perso¬ 
nalizan la cinemática inversa para cada robot individual. En este caso es conveniente 
comunicar la información a los controladores de robot a nivel cartesiano. 

Estas consideraciones por lo general significan que las funciones de cinemática direc¬ 
ta e inversa utilizadas por el simulador deben reflejar las funciones nominales utilizadas en 
el controlador de robot suministrado por el fabricante del robot. Hay varios detalles de 
la función cinemática inversa especificada por el fabricante que el simulador de software 
debe emular. Cualquier algoritmo de cinemática inversa debe hacer elecciones arbitrarias 
para poder resolver las singularidades. Por ejemplo, cuando la articulación 5 de un ro¬ 
bot PUMA 560 se encuentra en su posición cero, los ejes 4 y 6 se alinean y existe una 
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condición singular. La función de cinemática inversa en el controlador del robot puede 
despejar la suma de los ángulos de las articulaciones 4 y 6, pero después debe usar una 
regla arbitraria para elegir valores individuales para las articulaciones 4 y 6. El sistema 
OLP debe emular cualquier algoritmo que se utilice. Otro ejemplo sería elegir la solución 
más adecuada cuando existen muchas soluciones alternativas. El simulador debe utilizar 
el mismo algoritmo que el controlador para poder evitar potenciales errores catastróficos 
al simular el manipulador real. Una característica útil que se encuentra poco en los con¬ 
troladores de robots es la habilidad de comandar un destino cartesiano y especificar cuál 
de las posibles soluciones debe utilizar el manipulador. La existencia de esta característi¬ 
ca elimina el requerimiento de que el simulador emule el algoritmo de solución elegido; 
el sistema OLP puede simplemente forzar su elección en el controlador. 

Emulación de planeación de rutas 

Además de la emulación cinemática para el posicionamiento estático del manipulador, 
un sistema OLP debería emular con precisión la ruta tomada por el manipulador para 
moverse a través del espacio. De nuevo, el problema principal es que el sistema OLP 
necesita simular los algoritmos en el controlador de robot empleado, y dichos algorit¬ 
mos de planeación y ejecución de rutas varían considerablemente de un fabricante de 
robots a otro. La simulación de la forma espacial de la ruta tomada es importante para 
la detección de colisiones entre el robot y su entorno. La simulación de los aspectos 
temporales de la trayectoria es importante para predecir los tiempos de ciclo de las 
aplicaciones. Cuando un robot opera en un entorno móvil (por ejemplo, cerca de otro 
robot) es necesaria la simulación precisa de los atributos temporales de movimiento pa¬ 
ra predecir las colisiones con exactitud y, en algunos casos, para prever los problemas 
de comunicación o de sincronización, como el interbloqueo. 

Emulación dinámica 

El movimiento simulado de los manipuladores puede ignorar los atributos dinámicos si 
el sistema OLP hace un buen trabajo para emular el algoritmo de planeación de trayec¬ 
torias del controlador, y si el robot sigue las trayectorias deseadas con errores insignifi¬ 
cantes. No obstante, en condiciones de alta velocidad o bajo una carga pesada, los errores 
de rastreo de trayectorias pueden volverse importantes. Para simular estos errores de ras¬ 
treo se necesita tanto modelar el comportamiento dinámico del manipulador y de los obje¬ 
tos que mueve, como emular el algoritmo de control utilizado en el controlador del 
manipulador. En la actualidad existen problemas prácticos para obtener suficiente informa¬ 
ción de los fabricantes de robots como para que este tipo de simulación dinámica tenga un 
valor práctico pero, en algunos casos, la simulación dinámica puede lograrse con éxito. 

Simulación de múltiples procesos 

Algunas aplicaciones industriales involucran a dos o más robots que cooperan en el 
mismo entorno. Incluso hasta las células de trabajo con un solo robot contienen una 
banda transportadora, una línea de transferencia, un sistema de visión, o algún otro dis¬ 
positivo activo con el que el robot debe interactuar. Por esta razón es importante que un 
sistema OLP pueda simular múltiples dispositivos móviles y otras actividades que invo¬ 
lucren el paralelismo. Como base para esta capacidad, el lenguaje subyacente en el que 
se implementa el sistema debería ser un lenguaje de multiprocesamiento. Dicho am¬ 
biente hace posible la escritura de programas de control de robots independientes pa¬ 
ra cada uno de los dos o más robots en una sola célula, y luego se simula la acción de 
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la célula con los programas ejecutándose concurrentemente. Al agregar primitivas de 
señalización y espera al lenguaje se permite a los robots interactuar entre sí, de igual 
forma que lo harían en la aplicación que se está simulando. 

Simulación de sensores 

Los estudios han demostrado que un gran componente de los programas de robots con¬ 
siste no solamente de instrucciones de movimiento, sino de inicialización, comproba¬ 
ción de errores, E/S y de otros tipos [7]. Por ende, la habilidad del sistema OLP de ofrecer 
un entorno que permita la simulación de aplicaciones completas, incluyendo la interac¬ 
ción con sensores, varios tipos de E/S y la comunicación con otros dispositivos se vuelve 
importante. Un sistema OLP que soporte la simulación de sensores y multiprocesamien- 
to no sólo puede verificar la viabilidad de los movimientos del robot, sino que también 
puede verificar la porción de comunicación y sincronización del programa del robot. 

Traducción del lenguaje al sistema de destino 

Una molestia para los usuarios actuales de los robots industriales (y de cualquier otro 
tipo de automatización programable) es que casi todos los proveedores de dichos siste¬ 
mas han inventado un lenguaje único para programar su producto. Si un sistema OLP 
aspira a ser universal en el equipo que puede manejar, debe traducir desde y hacia dis¬ 
tintos lenguajes. Una opción para solucionar este problema es elegir un solo lenguaje a 
utilizar por el sistema OLP y después posprocesar el lenguaje para convertirlo al for¬ 
mato requerido por la máquina de destino. También es conveniente la habilidad de car¬ 
gar programas que ya existan en las máquinas de destino y llevarlos al sistema OLP. 

Dos beneficios potenciales de los sistemas OLP se relacionan directamente con el te¬ 
ma de traducción del lenguaje. La mayoría de los ponentes de los sistemas OLP saben que 
al tener una interfaz universal que permita a los usuarios programar una variedad de ro¬ 
bots, se resuelve el problema de aprender y tratar con varios lenguajes de automatización. 
Un segundo beneficio se deriva de las consideraciones económicas en escenarios futuros 
en los que cientos, o tal vez miles de robots, llenan las fábricas. El costo asociado con un 
poderoso entorno de programación (como un lenguaje y una interfaz gráfica) podría pro¬ 
hibir colocarlo en el sitio de instalación de cada robot. Parece que, en relación con lo eco¬ 
nómico, tiene sentido colocar un controlador muy simple, “tonto” y económico con cada 
robot y descargarlo desde un poderoso e “inteligente” sistema OLP que esté ubicado en 
un entorno de oficina. En consecuencia, el problema general de traducir un programa de 
aplicación de un poderoso lenguaje universal a un simple lenguaje diseñado para ejecutar¬ 
se en un procesador económico se vuelve un asunto importante en los sistemas OLP. 

Calibración de la célula de trabajo 

Una inevitable realidad de un modelo de computadora en cualquier situación del mundo 
real es la imprecisión en el modelo. Para poder hacer que los programas desarrollados 
en un sistema OLP puedan utilizarse, los métodos de calibración de la célula de trabajo 
deben ser una parte integral del sistema. La magnitud de este problema varía conside¬ 
rablemente dependiendo de la aplicación; esta variabilidad hace que la programación 
fuera de línea de algunas tareas sea mucho más práctica que la de otras. Si la mayor 
parte del trabajo indica que se le debe volver a enseñar al robot real una aplicación pa¬ 
ra resolver problemas de imprecisión, los sistemas OLP pierden su efectividad. 

Muchas aplicaciones implican el frecuente desempeño de acciones relativas a 
un objeto rígido. Considere por ejemplo la tarea de perforar varios cientos de hoyos en 
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un mamparo. La ubicación actual del mamparo relativa al robot puede programarse si 
se utiliza el robot para tomar tres mediciones. Las ubicaciones de todos los hoyos pue¬ 
den actualizarse automáticamente si están disponibles en coordenadas de piezas de un 
sistema CAD. En esta situación sólo hay que enseñar estos tres puntos al robot, en lu¬ 
gar de cientos. La mayoría de las tareas implica este tipo de paradigma de “muchas 
operaciones relativas a un objeto rígido”; por ejemplo, la inserción de componentes en ta¬ 
bleros de PC, el enrutamiento, la soldadura por puntos, la soldadura por arco, el aco¬ 
modo de tarimas, la pintura y el desbarbado. 

13.3 EL SIMULADOR 'PILOT' 

En esta sección consideraremos uno de esos sistemas de simulación fuera de línea: el sis¬ 
tema ‘Pilot’ desarrollado por Adept Technology [8], El sistema Pilot es en realidad una 
suite de tres sistemas de simulación muy relacionados entre sí; aquí veremos la porción 
de Pilot (conocida como “Pilot/Cell”) que se utiliza para simular una célula de trabajo in¬ 
dividual en una fábrica. En particular, este sistema es inusual ya que trata de modelar va¬ 
rios aspectos del mundo físico como un medio para liberar de carga al programador del 
simulador. En esta sección hablaremos de los “algoritmos geométricos” que se utilizan 
para dar al simulador la capacidad de emular ciertos aspectos de la realidad física. 

La necesidad de facilitar el uso impulsa a hacer que el sistema de simulación se com¬ 
porte como en el mundo físico real. Entre más parecido al mundo real actúe el simulador, 
más simple se volverá para el usuario el paradigma de la interfaz de usuario, ya que el 
mundo físico es el que todos conocemos. Al mismo tiempo, debido al intercambio de fa¬ 
cilidad de uso por velocidad computacional y otros factores, se ha producido un diseño en 
el que un “pedazo” específico de realidad se simula, mientras que muchos detalles no. 

Pilot se adapta bien como anfitrión ( host ) para una variedad de algoritmos geométri¬ 
cos. La necesidad de modelar varias porciones del mundo real, junto con la de facilitar al 
usuario su utilización mediante la automatización de cálculos geométricos frecuentes, im¬ 
pulsa a generar dichos algoritmos. Pilot proporciona el entorno en el que pueden aplicarse 
algunos algoritmos avanzados en los problemas reales que se presentan en la industria. 

Una decisión que se hizo desde el comienzo del diseño del sistema de simulación 
Pilot fue que el paradigma de programación debería ser lo más parecido posible a la 
manera en que se programaría el sistema de robot real. Se proporcionan ciertas herra¬ 
mientas de planeación y optimización de un nivel más alto, pero se consideró que era 
importante que la interacción de programación básica fuera similar a los sistemas de 
hardware actuales. Esta decisión ha conducido el desarrollo del producto hacia una ru¬ 
ta sobre la que encontramos la genuina necesidad de varios algoritmos geométricos. 
Los algoritmos necesarios varían ampliamente, desde los extremadamente simples has¬ 
ta los considerablemente complejos. 

Si se va a programar un simulador para igualar el comportamiento del mundo real, 
entonces las acciones y reacciones del mundo físico deben modelarse “automáticamen¬ 
te” por el simulador. El objetivo es liberar al usuario de tener que escribir cualquier “có¬ 
digo específico de simulación” en el sistema. Como un ejemplo sencillo, si se ordena a la 
pinza de sujeción del robot que se abra, la pieza que esté sujetando debe caer en respues¬ 
ta a la gravedad y posiblemente incluso rebotar y quedar en cierto estado estable. Si obli¬ 
gamos al usuario del sistema a especificar estas acciones del mundo real, el simulador no 
cumpliría su objetivo: ser programado de la misma forma en que funciona el sistema real. 
Sólo puede lograrse una máxima facilidad de uso cuando el mundo simulado “sabe có¬ 
mo” comportarse igual que el mundo real sin importunar al usuario. 
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La mayoría de los sistemas comerciales (si no es que todos) para simular robots u 
otros mecanismos no tratan directamente con este problema. En su lugar, “permiten” 
al usuario (en realidad, obligan al usuario) a incrustar comandos específicos de la simu¬ 
lación dentro del programa escrito para controlar el dispositivo simulado. Un ejemplo 
sencillo sería la siguiente secuencia de código: 

MOVE TO recoger_pieza 

CLOSE pinza 

affix(pinza, pieza[i]); 

MOVE TO colocar_pieza 

OPEN pinza 

unaffix(pinza, pieza[i]); 

Aquí se ha obligado al usuario a insertar comandos de “fijación” (affix) y “libe¬ 
ración” (unaffix), los que (respectivamente) hacen que la pieza se mueva con la pinza 
de sujeción cuando se recoge y que deje de moverse cuando se libera. Si el simulador 
permite que el robot sea programado en su lenguaje nativo, por lo general ese lengua¬ 
je no es lo suficientemente completo como para soportar estos comandos, por lo tanto 
requiere un segundo grupo de comandos, incluso hasta podría tener una sintaxis distin¬ 
ta para lidiar con las interacciones en el mundo real. Dicho esquema no está programa¬ 
do inherentemente “igual que el sistema físico”, por lo que debe producir un aumento 
en la carga de programación para el usuario. 

Del ejemplo anterior podemos ver el primer algoritmo geométrico para el que en¬ 
contramos una necesidad: de la geometría de la pinza de sujeción y las ubicaciones 
relativas de las piezas, averigüe qué pieza (si es que la hay) se sujetará cuando la pinza 
de sujeción se cierre y posiblemente cómo se autoalineará la pieza dentro de la pinza. 
En el caso de Pilot, resolvemos la primera parte de este problema con un algoritmo 
simple. En casos limitados, la “acción de alineación” de la pieza en la pinza se calcula, 
pero en general, dichas alineaciones tienen que ser programadas previamente por el 
usuario del sistema. Por ende podemos ver que Pilot no ha llegado al objetivo definiti¬ 
vo aún, pero ha dado algunos pasos en esa dirección. 

Modelado físico y sistemas interactivos 

En un sistema de simulación siempre se intercambia la complejidad del modelo en tér¬ 
minos de tiempo de cómputo por la precisión de la simulación. En el caso de Pilot y sus 
objetivos determinados, es muy importante mantener el sistema completamente inte¬ 
ractivo. Esto ha conducido a diseñar a Pilot de manera que pueda utilizar varios modelos 
aproximados; por ejemplo, el uso de aproximaciones cuasi-estáticas en donde un mo¬ 
delo por completo dinámico podría ser más preciso. Aunque parece haber la posibili¬ 
dad de que pronto puedan aplicarse los modelos “completamente dinámicos” [9], dado 
el estado actual del hardware de computadora, de los algoritmos dinámicos y de la 
complejidad de los modelos CAD que los usuarios industriales desean emplear, senti¬ 
mos que aún hay que hacer estos intercambios. 

Algoritmos geométricos para la caída de piezas 

En algunos sistemas de alimentación empleados en la práctica industrial, las piezas 
caen de cierta forma del transportador de alimentación interna hacia una superficie de 
presentación; luego se utiliza la visión computacional para localizar las piezas que el ro¬ 
bot va a tomar. El proceso de diseñar dichos sistemas de automatización con la ayuda 
de un simulador significa que éste debe ser capaz de predecir la manera en que las pie¬ 
zas van a caer, rebotar y tomar una orientación estable, o estado estable. 
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FIGURA 13.1: Los ocho estados estables de la pieza. 


Probabilidades de estado estable 

Como se informó en la referencia [10], se ha implementado un algoritmo que toma co¬ 
mo entrada cualquier forma geométrica (representada por un modelo CAD) y, para esa 
forma, puede calcular las N posibles formas en que puede permanecer estable en una 
superficie horizontal. A estas formas se les conoce como estados estables de la pieza. 
Además, el algoritmo utiliza un método perturbado cuasi-estático para estimar la pro¬ 
babilidad asociada a cada uno de los N estados estables. Hemos realizado experimentos 
físicos con piezas de muestra para valorar la precisión resultante de la predicción de es¬ 
tado estable. 

La figura 13.1 muestra los ocho estados estables de una pieza de prueba específi¬ 
ca. Utilizando un robot Adept y un sistema de visión, dejamos caer esta pieza más de 
26 mil veces y registramos el estado estable resultante para comparar nuestro algorit¬ 
mo de predicción de estado estable con la realidad. La tabla 13.1 muestra los resulta¬ 
dos para la pieza de prueba, los cuales son característicos de nuestro algoritmo actual; 
el error de predicción de probabilidad de estado estable varía por lo regular del 5 al 10 
por ciento. 

Ajuste de las probabilidades como función de la altura de la caída 

Evidentemente, si se deja caer una pieza de una pinza de sujeción desde una altura muy 
pequeña (por ejemplo, 1 mm) sobre una superficie, las probabilidades de los diversos es¬ 
tados estables difieren de las que ocurren cuando la pieza se deja caer desde una altura 
mayor a cierta altura crítica. En Pilot utilizamos probabilidades del algoritmo estimador 
de estado estable cuando se dejan caer piezas desde alturas iguales o mayores que la mayor 
dimensión de la pieza. Para las alturas de caída por debajo de este valor, las probabili¬ 
dades se ajustan para tomar en cuenta la orientación inicial de la pieza y la altura de la 
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TABLA 13.1: Comparación entre probabilidades pronosticadas 
y reales de estado estable para la pieza de prueba 


Estado estable 

# real 

% real 

% pronosticado 

LU 

1871 

7.03% 

8.91% 

LD 

10,600 

39.80% 

44.29% 

TP 

648 

2.43% 

7.42% 

BT 

33 

0.12% 

8.19% 

SR 

6467 

24.28% 

15.90% 

SL 

6583 

24.72% 

15.29% 

AR/AL 

428 

1.61% 

0.00% 

Total 

26,630 

100% 

100% 


caída. El ajuste es tal que, a medida que se llega a una altura de caída infinitesimal, la 
pieza permanece en su orientación inicial (suponiendo que sea una orientación estable). 
Ésta es una adición importante al algoritmo de probabilidad general, ya que es común 
que se liberen piezas a una distancia pequeña sobre una superficie de apoyo. 

Simulación del rebote 

Las piezas en Pilot están etiquetadas con su coeficiente de restitución; también lo están 
todas las superficies en las que pueden colocarse las piezas. El producto de estos dos 
factores se utiliza en una fórmula para predecir qué tan lejos rebotará la pieza cuando 
se deje caer. Estos detalles son importantes, ya que afectan la forma en que las piezas se 
esparcen o se agrupan en la simulación de ciertos sistemas de alimentación. Al rebotar, 
las piezas se esparcen en forma radial, de acuerdo a una distribución uniforme. La dis¬ 
tancia de rebote (lejos del punto inicial de contacto) es una cierta función de distribu¬ 
ción hasta una distancia máxima, la cual se calcula como una función de la altura de 
caída (entrada de energía) y los coeficientes de restitución que se apliquen. 

Las piezas en Pilot pueden rebotar en forma recursiva de superficie en superficie 
en ciertos arreglos. También es posible marcar ciertas superficies de tal forma que las 
piezas no puedan rebotar fuera de ellas, sino sólo dentro de ellas. Las entidades cono¬ 
cidas como recipientes en Pilot tienen esta propiedad; las piezas pueden caer en ellos, 
pero nunca rebotar hacia afuera. 

Simulación de apilamiento y enredamiento 

Como una simplificación, las piezas en Pilot siempre descansan en superficies de apo¬ 
yo planas. Si las piezas se enredan o se apilan una sobre otra, esto se muestra como pie¬ 
zas que se intersecan entre sí (esto es, la intersección booleana de sus volúmenes no 
estaría vacía). Esto ahorra la enorme cantidad de cálculos que tendrían que realizarse 
para calcular las diversas formas en que una pieza podría apilarse o enredarse con la 
geometría de otra pieza. 

Las piezas en Pilot están etiquetadas con un factor de enredamiento. Por ejemplo, 
una canica tendría un factor de enredamiento de 0.0 ya que, cuando se dejan caer en una 
superficie de apoyo, las canicas nunca se apilan o enredan, sino que tienden a esparcirse 
en la superficie. Por otra parte, piezas como los resortes en espiral podrían tener un fac¬ 
tor de enredamiento cercano a 1.0, y es muy probable que se enreden uno con otro. 
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Cuando una pieza cae y rebota se ejecuta un algoritmo para encontrar el espacio, en 
donde la pieza trata de rebotar hacia un espacio abierto. Sin embargo, la exactitud con 
la que trate de encontrar un espacio abierto es una función de su factor de enredamien- 
to. Mediante el ajuste de este coeficiente, Pilot puede simular piezas que se dejan caer 
y se enredan en mayor o menor grado. En la actualidad no existe un algoritmo para 
calcular automáticamente el factor de enredamiento a partir de la geometría de la pie¬ 
za; éste es un interesante problema abierto. A través de la interfaz, el usuario de Pilot 
puede establecer el factor de enredamiento al valor que considere apropiado. 

Algoritmos geométricos para sujetar piezas 

La mayor parte de la dificultad en programar y utilizar robots tiene que ver con los de¬ 
talles de programar las ubicaciones de sujeción en las piezas y con el diseño detallado 
de las pinzas de sujeción. Ésta es un área en la que los algoritmos de planeación adicio¬ 
nales en un sistema simulador podrían tener un gran impacto. En esta sección veremos 
los algoritmos que se utilizan actualmente en Pilot. Los métodos actuales son bastante 
simples, por lo que ésta es un área de trabajo continuo. 

Cómo calcular qué pieza sujetar 

Cuando una herramienta se cierra, o cuando se acciona un efector final de succión, Pi¬ 
lot aplica un algoritmo simple para calcular qué parte (si la hay) debe ser sujetada por 
el robot. Primero, el sistema averigua qué superficie de apoyo se encuentra inmediata¬ 
mente debajo de la pinza de sujeción. Después, para todas las piezas en la superficie, 
busca aquélla cuya caja delimitadora (para el estado estable actual) contenga el TCP 
(punto central de la herramienta) de la pinza de sujeción. Si más de una pieza cumple 
con este criterio, entonces selecciona la que se encuentre más cerca. 

Cálculo de la ubicación de sujeción predeterminada 

Pilot asigna automáticamente una ubicación de sujeción para cada orientación estable 
pronosticada por el estimador de estado estable descrito antes. El algoritmo actual es 
simplista, por lo que también se proporciona una interfaz gráfica de usuario para que 
éste pueda editar y redefinir estos puntos de sujeción. El algoritmo de sujeción actual 
es una función de la caja delimitadora de la pieza y de la geometría de la pinza de su¬ 
jeción, que se supone debe ser una pinza de sujeción tipo quijada en paralelo o una ven¬ 
tosa. Además de calcular una ubicación de sujeción predeterminada para cada estado 
estable, también se calculan un acercamiento predeterminado y una altura de salida. 

Cálculo de la alineación de la pieza durante la sujeción 

En ciertos casos importantes de la práctica industrial, el diseñador del sistema cuenta 
con el hecho de que, cuando se acciona el efector final del robot, la pieza capturada se 
alinea por sí sola en cierta forma con las superficies del efector final. Este efecto pue¬ 
de ser importante para eliminar los pequeños desalineamientos en la presentación de 
las piezas al robot. 

Un efecto bastante real que necesita simularse es que con las pinzas de sujeción 
tipo ventosa, puede darse el caso de que al aplicar succión, la pieza se “levante” hacia 
la ventosa en forma tal que altere considerablemente su orientación relativa al efector 
final. Pilot simula este efecto marcando la geometría de la pieza con una línea vertical 
alineada con la línea central de la ventosa. La faceta del modelo poligonal de la pieza 
que se marque es la que se utiliza para calcular la orientación al momento de la sujeción; 
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la normal de esta faceta se antialínea con la normal de la parte inferior de la ventosa. 
Al alterar la orientación de la pieza se minimiza la rotación sobre esta línea de marca¬ 
do (la pieza no gira sobre el eje de la ventosa cuando se sujeta). Sin la simulación de es¬ 
te efecto, el simulador no podría representar en forma realista ciertas estrategias de 
“recoger y colocar” en las que se utilicen pinzas de sujeción tipo succión. 

También hemos implementado un planificador que permite que las piezas giren 
sobre el eje Z cuando una pinza de sujeción tipo quijada en paralelo se cierra sobre 
ellas. Este caso es automático sólo para un caso simple; en otras situaciones, el usuario 
debe enseñar la alineación resultante (es decir, aún estamos esperando un algoritmo 
que esté más cerca de estar terminado). 

Algoritmos geométricos para empujar piezas 

Un estilo de empuje de piezas ocurre entre las quijadas de una pinza de sujeción, como se 
mencionó en la sección anterior. En la práctica industrial actual, las piezas algunas veces 
son empujadas por mecanismos simples. Por ejemplo, después de que un alimentador de 
tazón presenta una pieza, ésta podría ser empujada por un actuador lineal justo hacia un 
ensamblaje que se haya llevado a la celda a través de un sistema transportador de bandeja. 

Pilot tiene capacidad para simular el empuje de las piezas: una entidad llamada 
barra de empuje, la cual puede unirse a un cilindro neumático o a un actuador de tor¬ 
nillo de avance en el simulador. Cuando el actuador mueve la barra de empuje a lo lar¬ 
go de una ruta lineal, la superficie delantera de la barra de empuje mueve las piezas. 
En el futuro se planea que las barras de empuje también puedan agregarse como guías 
a lo largo de los transportadores o que puedan colocarse en cualquier parte que requie¬ 
ra que el movimiento de las piezas se vea afectado por su presencia. El empuje actual 
es aún muy simple, pero es suficiente para muchas tareas del mundo real. 

Algoritmos geométricos para los transportadores de bandeja 

Pilot soporta la simulación de sistemas de transportadores de bandeja en los que las 
bandejas se mueven a lo largo de rastros compuestos por componentes en línea recta y 
de corte circular. Puede haber compuertas colocadas a lo largo de los rastros en ubica¬ 
ciones clave, las cuales se abren temporalmente para bloquear una bandeja cuando se 
le ordena. Además, pueden colocarse sensores que detecten el paso de una bandeja en 
ubicaciones especificadas por el usuario. Dichos sistemas de transportación son comu¬ 
nes en muchos esquemas de automatización. 

Conexión de transportadores de bandeja, fuentes y vertederos 

Los transportadores de bandeja pueden conectarse entre sí para permitir varios estilos 
de ramificaciones. Donde dos transportadores “fluyen juntos”, se proporciona un es¬ 
quema simple para evitar colisiones, para hacer que las bandejas del transportador se¬ 
cundario sean subordinadas a las bandejas del transportador principal. Las bandejas en 
el transportador secundario esperarán siempre que pueda ocurrir una colisión. En las 
conexiones de “flujo aparte” se agrega un dispositivo llamado director al transportador 
principal, el cual puede utilizarse para controlar la dirección que tomará una bandeja 
en la intersección. Las líneas de E/S digitales conectadas al controlador de robot simu¬ 
lado se utilizan para leer sensores, activar compuertas y activar directores. 

En los extremos de un transportador de bandejas hay una fuente y un vertedero. 
El usuario establece las fuentes para generar bandejas en ciertos intervalos estadísticos. 
Las bandejas generadas podrían estar vacías o precargadas con piezas o dispositivos 
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fijos. En el extremo de un transportador de bandeja, éstas (y su contenido) desapare¬ 
cen en los vertederos. Cada vez que una bandeja entra en un vertedero se registra su 
tiempo de llegada y su contenido. Estos registros de vertedero pueden entonces repro¬ 
ducirse a través de una fuente en cualquier otra parte del sistema. Por ende, una línea 
de células puede estudiarse en el simulador célula por célula, estableciendo la fuente de la 
célula N + 1 con el registro de vertedero de la célula N. 

Empuje de las bandejas 

También se implementa el empuje para las bandejas: puede usarse una barra de empu¬ 
je para propulsar una bandeja fuera de un sistema transportador de bandejas y hacia una 
célula de trabajo específica. De igual forma, las bandejas pueden empujarse hacia un trans¬ 
portador de bandeja. La actualización de diversas estructuras de datos cuando las bandejas 
salen de un transportador o entran en uno es una parte automática del código de empuje. 

Algoritmos geométricos para los sensores 

Se requiere la simulación de varios sistemas de sensores para que el usuario no tenga 
que escribir código para emular su comportamiento en la célula. 

Sensores de proximidad 

Pilot soporta la simulación de sensores de proximidad y de otros tipos. En el caso de los 
sensores de proximidad, el usuario etiqueta el dispositivo con sus rangos mínimo y máximo, 
y con un umbral. Si un objeto está dentro del rango y más cerca que el umbral, entonces el 
sensor lo detecta. Para realizar este cálculo en el mundo simulado, se agrega temporalmen¬ 
te un segmento de línea al entorno simulado, uno que se estire del rango mínimo al rango 
máximo del sensor. Usando un algoritmo de colisiones, el sistema calcula las ubicaciones en 
las que este segmento de línea se interseca con otra geometría CAD. El punto de intersec¬ 
ción más cercano al sensor corresponde al elemento del mundo real que habría detenido el 
rayo. Una comparación de la distancia a este punto y el umbral proporciona la salida del 
sensor. Hasta hoy no hacemos uso del ángulo de la superficie encontrada o de sus propie¬ 
dades de reflectancia, aunque tal vez podrían agregarse esas características en el futuro. 

Sistemas de visión 2-D 

Pilot simula el desempeño del sistema de visión 2-D de Adept. La manera en que tra¬ 
baja el sistema de visión simulado está estrechamente relacionada con la manera en 
que trabaja el sistema de visión real, incluso la manera en que está programado en el 
lenguaje AIM [11] utilizado por los robots de Adept. Se simulan los siguientes elemen¬ 
tos de este sistema de visión: 

• La forma y la extensión del campo de vista. 

• La distancia de referencia y un simple modelo de enfoque. 

• El tiempo requerido para realizar el procesamiento de la visión (aproximado). 

• El orden espacial de los resultados en la cola, en caso de que se encuentren mu¬ 
chas piezas en una imagen. 

• La habilidad de distinguir las piezas de acuerdo con el estado estable en el que 
se encuentren. 

• La incapacidad de reconocer piezas que se tocan entre sí o se superponen. 

• Dentro del contexto de AIM, la habilidad de actualizar las metas del robot con 
base en los resultados de la visión. 
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El uso de un sistema de visión está bien integrado con el sistema de programación 
de robots AIM, por lo que la implementación de este lenguaje en el simulador implica 
también el de la emulación del sistema de visión. AIM soporta varias instrucciones que 
facilitan el uso de la visión para guía del robot. El proceso de recoger piezas que se 
identifiquen visualmente gracias a la indización y el rastreo de los transportadores se lo¬ 
gra con cierta facilidad. 

Una estructura de datos lleva el registro de cuál superficie de apoyo es la que está 
observando el sistema de visión. Para todas las piezas apoyadas en esa superficie, calcu¬ 
lamos cuáles están dentro del campo del sistema de visión. Descartamos las piezas que 
estén demasiado cerca o demasiado lejos de la cámara (es decir, desenfocados), y las 
que toquen piezas adyacentes. De las piezas restantes elegimos las que se encuentren 
en el estado estable demandado y las colocamos en una lista. Finalmente, esta lista se or¬ 
dena para emular el que utiliza el sistema de visión de Adept cuando se encuentran va¬ 
rias piezas en una escena. 

Sensores inspectores 

Se proporciona una clase especial de sensores, llamados inspectores. Un inspector se 
utiliza para proporcionar una salida binaria para cada pieza que esté colocada en fren¬ 
te de él. Las piezas en Pilot pueden etiquetarse con una proporción de defectos y los ins¬ 
pectores pueden descartar las piezas defectuosas. Los inspectores juegan el papel de 
varios sistemas de sensores del mundo real. 

Conclusión 

Como se mencionó, aunque hay algunos algoritmos geométricos simples actualmente 
en funcionamiento en el simulador, existe la necesidad de más y mejores algoritmos. En 
especial nos gustaría investigar la posibilidad de agregar una capacidad de simulación 
cuasi-estática para predecir el movimiento de los objetos en situaciones en las que los 
efectos de fricción dominan cualquier efecto inercial. Esto podría usarse para simular 
las piezas que se empujan o se inclinan debido a diversas acciones de los efectores fina¬ 
les u otros mecanismos de empuje. 

13.4 AUTOMATIZACIÓN DE SUBTAREAS EN SISTEMAS OLP 

En esta sección mencionaremos brevemente algunas características avanzadas que po¬ 
drían integrarse en la “línea base” del concepto de sistema OLP que ya presentamos. 
La mayoría de estas características realizan la planeación automatizada de cierta por¬ 
ción, pequeña, de una aplicación industrial. 

Colocación automática del robot 

Una de las tareas más básicas que pueden lograrse por medio de un sistema OLP es la 
determinación de la distribución de la célula de trabajo, de manera que uno o más mani¬ 
puladores puedan llegar a todos los puntos de trabajo requeridos. La operación de deter¬ 
minar la colocación correcta del robot o de la pieza de trabajo mediante prueba y error 
se completa mucho más rápido en un mundo simulado que en la célula física. Una carac¬ 
terística avanzada que automatiza la búsqueda de ubicaciones factibles para un robot o 
una pieza de trabajo logra avanzar un paso más para reducir la carga sobre el usuario. 

La colocación automática puede calcularse mediante una búsqueda directa o (al¬ 
gunas veces) mediante técnicas de búsqueda guiadas por heurística. La mayoría de los 
robots se montan nivelados en el piso (o techo) y tienen la primera articulación giratoria 
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perpendicular al piso, por lo que generalmente no se necesita más que hacer una bús¬ 
queda por escalado del espacio tridimensional de la colocación del robot. La búsqueda 
podría optimizar ciertos criterios o podría detenerse al localizar la primera colocación 
viable del robot o de la pieza. La viabilidad se define como la habilidad de llegar libre 
de colisiones a todos los puntos de trabajo (o tal vez se le pueda dar una definición aún 
más sólida). Un criterio razonable para maximizar podría ser cierta forma de medida 
de manipulabilidad, como se discutió en el capítulo 8. En la referencia [12] se ha des¬ 
crito una implementación que utiliza una medida similar de manipulabilidad. El resul¬ 
tado de dicha colocación automática es una célula en la que el robot puede llegar a 
todos sus puntos de trabajo en configuraciones bien acondicionadas. 

Evasión de colisiones y optimización de rutas 

La investigación sobre la planeación de rutas libres de colisiones [13,14] y la planeación 
de rutas óptimas [15, 16] genera candidatos naturales para incluirse en un sistema OLE 
Algunos problemas relacionados que tienen un alcance menor y un espacio de búsqueda 
más reducido son también de interés. Por ejemplo, considere el problema de utilizar un 
robot con seis grados de libertad para una tarea de soldadura por arco cuya geometría es¬ 
pecifica sólo cinco grados de libertad. Puede utilizarse la planeación automática del gra¬ 
do redundante de libertad para evitar colisiones y singularidades del robot [17]. 

Planeación automática del movimiento coordinado 

En muchas situaciones de soldadura por arco, los detalles del proceso requieren que se 
mantenga cierta relación entre la pieza de trabajo y el vector de gravedad durante la ta¬ 
rea de soldado. Esto produce un sistema de orientación con dos o tres grados de liber¬ 
tad en el que se monta la pieza, operando simultáneamente con el robot y en forma 
coordinada. En un sistema de este tipo, podría haber nueve o más grados de libertad 
para coordinar. Dichos sistemas por lo común se programan actualmente mediante el 
uso de técnicas de dispositivo de enseñanza. Sería muy valioso un sistema de planea¬ 
ción que pudiera sintetizar automáticamente los movimientos coordinados para dicho 
sistema [17,18]. 

Simulación del control de fuerza 

En un mundo simulado en el que los objetos se representan por sus superficies, es po¬ 
sible investigar la simulación de estrategias de control de fuerza del manipulador. Esta 
tarea involucra el difícil problema de modelar ciertas propiedades de la superficie y ex¬ 
pandir el simulador dinámico para lidiar con las restricciones impuestas por varias si¬ 
tuaciones de contacto. En dicho entorno, sería posible evaluar la viabilidad de varias 
operaciones de ensamblaje controlado por fuerza [19]. 

Programación automática 

Además de los problemas geométricos existentes en la programación de robots, a me¬ 
nudo existen dificultades de programación y comunicación. Esto ocurre especialmente si 
expandimos la simulación más allá de una sola célula de trabajo a un grupo de células. 
Algunos sistemas de simulación de tiempo discreto ofrecen la simulación abstracta de di¬ 
chos sistemas [20], pero pocos ofrecen algoritmos de planeación. La planeación de itine¬ 
rarios para los procesos que interactúan es un problema difícil y un área de investigación 
[21, 22]. Un sistema OLP serviría como un medio de prueba ideal para dicha investiga¬ 
ción y sería mejorado inmediatamente por cualquier algoritmo útil en esta área. 
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Valoración automática de errores y tolerancias 

Un sistema OLP podría recibir algunas de las capacidades descritas en trabajos recien¬ 
tes para modelar fuentes de error de posicionamiento y el efecto de los datos prove¬ 
nientes de sensores imperfectos [23, 24]. El modelo real podría diseñarse para incluir 
varios límites de error e información de tolerancia, y el sistema podría evaluar las pro¬ 
babilidades de éxito de varias tareas de posicionamiento o de ensamblaje. El sistema 
podría sugerir el uso y la colocación de sensores para corregir problemas potenciales. 

Los sistemas de programación fuera de línea son útiles en las aplicaciones indus¬ 
triales actuales, y pueden servir como base para la investigación y el desarrollo conti¬ 
nuos de la robótica. Una gran innovación en el desarrollo de sistemas OLP es llenar el 
hueco existente entre los sistemas programados explícitamente que están disponibles 
actualmente, y los sistemas a nivel de tarea del mañana. 
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EJERCICIOS 

13.1 [10] Defina en una o dos oraciones lo que es detección de colisiones, evasión de coli¬ 
siones y planeación de rutas libre de colisiones. 

13.2 [10] Defina en una o dos oraciones lo que es modelo del entorno, emulación de pla¬ 
neación de rutas y emulación dinámica. 

13.3 [10] Defina en una o dos oraciones lo que es colocación automática de robots, rutas 
óptimas en tiempo y análisis de propagación de errores. 

13.4 [10] Defina en una o dos oraciones RPL, TLP y OLP. 

13.5 [10] Defina en una o dos oraciones lo que es calibración, movimiento coordinado y 
programación automática. 

13.6 [20] Genere un gráfico que indique cómo ha aumentado la habilidad gráfica de las 
computadoras durante los últimos diez años (tal vez en términos del número de vec¬ 
tores dibujados por segundo, por cada 10,000 dólares de hardware). 

13.7 [20] Haga una lista de tareas que estén caracterizadas por “muchas operaciones rela¬ 
tivas a un objeto rígido” y que por lo tanto sean candidatas para la programación fue¬ 
ra de línea. 

13.8 [20] Escriba las ventajas y desventajas de utilizar un sistema de programación que 
mantenga un modelo detallado del entorno en forma interna. 
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EJERCICIO DE PROGRAMACIÓN (PARTE 13) 

1. Considere la forma plana de una barra con tapones terminales. A esta forma la llama¬ 
remos “cápsula”. Escriba una rutina que, dada la ubicación de dos de esas cápsulas, 
calcule si se están tocando. Tenga en cuenta que todos los puntos superficiales de una 
cápsula son equidistantes desde un segmento de una sola línea que podría llamarse su 
“espina dorsal”. 

2. Introduzca un objeto en forma de cápsula cerca de su manipulador simulado y prue¬ 
be si hay colisiones a medida que mueve el manipulador sobre una ruta. Use vínculos 
en forma de cápsulas para el manipulador. Reporte cualquier colisión. 

3. Si el tiempo y la computadora lo permiten, escriba rutinas para describir gráficamen¬ 
te las cápsulas que forman su manipulador y los obstáculos en el espacio de trabajo. 
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Para girar un vector Q sobre un vector unitario K con base en 0, se utiliza la 

fórmula de Rodrigues: 

Q' = Q eos 9 + sen 0(K x Q) + (1 — eos 0)(K ■ Q)K. (A.9) 

En el apéndice B puede consultar las matrices de rotación equivalentes para las con¬ 
venciones de los 24 conjuntos de ángulos, y en el apéndice C puede consultar algunas 
identidades de cinemática inversa. 


APÉNDICE B 


Convenciones de los 24 
conjuntos de ángulos 


Los 12 conjuntos de ángulos de Euler se dan con base en 


Rx'Y'zP> Y) 


Rx'Z'Y'( a ’ P’ Y) 


Ry'X'Z't 01 ' P' y) 


Ryz'xP*Y) 


Rz'x’y'Í 01 ’ P’Y) 


Rz'Y' x'( a ' P' Y) 


r x'Y'X '(«> P> Y) 


Rx'Z'X'( a ' P’ y) 


R Y >x'Y'( a ' P' Y) 


cficy —cfisy sfi 

sasficy + casy —sasfisy + cacy —sacfi 
—casficy + sasy casfisy + sacy cacfi 

cficy —s¡6 cfisy 

casficy + sasy cacfi casfisy — sacy , 
sasficy — casy sacfi sasfisy + cacy 

sasfisy + cacy sasficy — casy sacfi 

cfisy cficy —sfi , 

casfisy — sacy casficy + sasy cacfi 

cacfi —casficy + sasy casfisy + sacy 
sfi cficy —cfisy 

—sacfi sasficy + casy —sasfisy + cacy 

—sasfisy + cacy —sacfi sasficy + casy 
casfisy + sacy cacfi —casficy + sasy 

—cfisy sfi cficy 

cacfi casfisy — sacy casficy + sasy 
sacfi —sasfisy + cacy —sasficy — casy 
—sfi cfisy cficy 

cfi sfisy sficy 

sasfi —sacfisy + cacy —sacficy — casy 
—casfi cacfisy + sacy cacficy — sasy 

cfi —sficy sfisy 

casfi cacficy — sasy —cacfisy — sacy , 
sasfi sacficy + casy —sacfisy + cacy 

—sacfisy + cacy sasfi sacficy + casy 

sfisy cfi —sficy , 

—cacfisy — sacy casfi cacficy — sasy 
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Ry’Z’Y '(®> P’ Y) 


cacficy — sasy —casfi cacfisy + sacy 
sficy cfi sfisy 

—sacficy — casy sasfi —sacfisy + cacy 


Rz'X'Z'( a ’ P> Y) 


—sacjisy + cacy —sacficy — casy sasji 
cacfisy + sacy cacficy — sasy —casfi , 

sfisy s/icy cji 


RZ’Y’Z '(“> PiY) 


cacficy — sasy —cacfisy — sacy casfi 
sacficy + casy —sacfisy + cacy sas/3 
—sficy sfisy cfi 


Los 12 conjuntos de ángulos fijos se dan con base en 


Rxyz^Y > P’ a ) = 

Rxzy^Y > P i a ) = 

RyxzÍY > a ) = 

Ryzx(Y’ P' “) = 

Rzxy^Y > a ) = 

Rzyx(Y’ P’ a ) = 

R XYx(Y’P ’ a ) = 

r xzx(y >“) = 

R Y xy(Y’P’ 01 ) = 


cacfi casfisy — sacy casficy + sasy 
sac/3 sasfisy + cacy sasficy — casy , 

—sfi cfisy cficy 

cacfi —casficy + sasy casfisy + sacy 
sfi cficy —cfisy , 

—sacfi sasficy + casy —sasfisy + cacy 

—sasfisy + cacy —sacfi sasficy + casy 
casfisy + sacy cacfi —casficy + sasy , 

—cfisy sfi cficy 

cficy —sfi cfisy 

casficy + sasy cacfi casfisy — sacy , 
sasficy — casy sacfi sasfisy + cacy 

sasfisy + cacy sasficy — casy sacfi 

cfisy cficy —sfi , 

casfisy — sacy casficy + sasy cacfi 

cficy —cfisy sfi 

sasficy + casy —sasfisy + cacy —sacfi , 
—casficy + sasy casfisy + sacy cacfi 

cfi sfisy sficy 

sasfi —sacfisy + cacy —sacficy — casy , 
—casfi cacfisy + sacy cacficy — sasy 

cfi —sficy sfisy 

casfi cacficy — sasy —cacfisy — sacy , 
sasfi sacficy + casy —sacfisy + cacy 

—sacfisy +cacy sasfi sacficy +casy 

sfisy cfi —sficy , 

—cacfisy — sacy casfi cacficy — sasy 
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RyzyÍY’ &■> a ) 

R zxz(Y > P’ “) 

Rzyz(Y’ P’ 


cacjícy — sasy —casjí cacjísy + sacy 
sjícy c¡6 sjísy 

—sacfícy — casy sasjí —sacjísy + cacy 

—sacjísy + cacy —sacfícy — casy sasjí 
cacjísy + sacy cacjícy — sasy —casjí 
sjísy sjícy cjí 

cacjícy — sasy —cacjísy — sacy casjí 
sacfícy + casy —sacfísy + cacy sasjí 
—sfícy s/ísy cjí 








APÉNDICE C 

Algunas fórmulas 
de cinemática inversa 


La ecuación individual 


sen# = a 

tiene dos soluciones, dadas por 

(C.l) 

0 — ±Atan2(V 1 — a 2 , a). 

De igual forma, dada la ecuación 

(C.2) 

eos 0 = b, 

existen dos soluciones: 

(C.3) 

0 = Atan2(¿, ±/L - b 2 ). 

Si se dan (C.l) y (C.3), entonces existe una solución única dada por 

(C.4) 

0 = Atan2(a, b ). 

La ecuación trascendental 

(C.5) 

a eos 0 + b sen 0 = 0 

tiene las siguientes dos soluciones: 

(C.6) 

0 = Atan2(a, —b) 

y 

(C.7) 

0 = Atan2(— a, b). 

La ecuación 

(C.8) 

a eos 0 + b sen# = c, 

(C.9) 

que resolvimos en la sección 4.5 con las sustituciones de la tangente del medio ángulo, 
también se resuelve mediante 

6 = Atan2(/?, a) ± Atan2 (V a 2 + b 2 — c 2 , c). 

El conjunto de ecuaciones 

a eos# — #sen# = c, 

(C.10) 

a sen# + b eos# = d, 

que se resolvió en la sección 4.4, también se resuelve mediante 

(C.11) 


0 = Atan2 (ad — be, ac + bd). 


(C.12) 






Soluciones de ejercicios 
seleccionados 

CAPÍTULO 2 EJERCICIOS SOBRE DESCRIPCIONES ESPACIALES Y TRANSFORMACIONES 

2 . 1 ) 


R = ROT(x, (¡>)ROT(z, 0) 


1 

0 

0 

" ce 

-se 

0" 

0 

C<t> 

-S<p 

se 

ce 

0 

0 

s<¡) 

C(p 

0 

0 

i 


ce -se o 
Ccpse C(pce -S4> 
scpse Scpco Cc¡) 


2 . 12 ) La velocidad es un “vector libre” y se ve afectada sólo por la rotación, no por la 
traslación: 


2.27) 


2.33) 


"0.866 -0.5 0" 


' 10“ 

0.5 0.866 0 


20 

0 0 1 


30 


= [ -1.34 22.32 30.0] 7 


A 

B 


T = 


-1 0 0 3 

0-100 
0 0 10 
0 0 0 1 


-0.866 

-0.5 

0 

3 

0 

0 

+1 

0 

-0.5 

0.866 

0 

0 

0 

0 

0 

1 


CAPÍTULO 3 EJERCICIOS SOBRE CINEMÁTICA DE MANIPULADORES 


“i-1 

a i -1 

di 

0 

0 

0 

0 

¿1 

0 

0 

L 2 

0 


3.1) 
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o 

i 


T = 


Cy -Sy 0 0 

Sy C] 0 0 
0 0 10 
0 0 0 1 


1 

2 


o 

3 



' c 2 —S 2 0 

V 


C3 — S 3 0 L 2 


5 2 C 2 0 

0 

2y _ 

s 3 c 3 0 o - 


0 0 1 

0 

3 1 - 

0 0 10 


0 0 0 

1 


0 0 0 1 



C 123 *^123 0 + L 2 Cy 2 

0 rp 1 rji 2y 

^123 Cl 23 0 + L 2^\2 

1 2 3 _ 

0 

0 

1 0 


o o 


en donde 


Cy 22 — COS(0| + 0 2 + $3) 
^123 = sen( 0 j + 0 2 + $3) 


3.8) Cuando ¡G¡ = ¡7], tenemos que 

B y W y _ B y S y 

W T S G 


Por lo que 


W y B y — 1 fiy 5 y 

T W S G 


CAPÍTULO 4 EJERCICIOS SOBRE CINEMÁTICA INVERSA DE MANIPULADORES 

4.14) No. El método de Pieper proporciona la solución de forma cerrada para cual 
quier manipulador 3-DOF. (Vea su tesis para todos los casos). 

4.18) 2 
4.22) 1 


CAPÍTULO 5 EJERCICIOS SOBRE JACOBIANOS: VELOCIDADES Y FUERZAS ESTÁTICAS 

5.1) El jacobiano en la trama {0} es 


°J(6) = 
DET (°J(9)) = 


-LySy 
LyCy 4 


“ L 2^12 
L 2 c n 


~L 2 Sy 2 

L 2^\2 


~(L 2 Cy 2 ) (LySy + L 2 Sy 2 ) + (L 2 Sy 2 )(LyCy + L 2 Cy 2 ) 


-LyL 2 SyCy 2 


L 2^\2^\2 ' 


LyL 2 CyS 12 + L^Sy 2 C 12 


— ^1 ^2^1 ^12 ~ LyL 2 SyCy 2 — LyL 2 (CySy 2 — SyCy 2 ) 

— LyL 2 S 2 


el mismo resultado que cuando se empieza con a ./( 9 ), a saber, las configurado 
nes singulares son 6 1 — 0 o o 180°. 
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5.8) El jacobiano de este manipulador de 2 vínculos es 

3 /( 0 ) = 

Existe un punto isotrópico si 


L t S 2 0 

l 1 c 2 + l 2 l 2 


v = 


L, 0 
0" L, 


Por lo tanto. 


¿i5 2 — L 2 

L\C 2 + l 2 = o 


Ahora, s 2 + C\ = 1, por lo que (h\ 2 + = 1. 

o L 2 = 2 L 3 L, = V2 L 2 . 

Bajo esta condición, S 2 = -^= = ±.707 
y C 2 = -.707. 

.'. Existe un punto isotrópico si L í = \/7.L 1 , y en ese caso existe cuando (> 2 — ±135°. 



- 135 ° 


7777777777777777777777777777777777, 


En esta configuración, el manipulador se ve momentáneamente como un mani¬ 
pulador cartesiano. 

5.13) 

r = °J t (0)°F 


T - 

-L l S 1 — L 2 S 12 L ,C| ± L 2 C ]2 

"10' 

i - 

—l 2 s 12 l 2 c 12 

0 


t, =-10 S 1 L l - 10L 2 S 12 
t 2 = —10L 2 S 12 

CAPÍTULO 6 EJERCICIOS SOBRE DINÁMICA DE MANIPULADORES 

6.1) Use la ecuación (6.17), pero escrita en forma polar, ya que es más sencillo. Por 
ejemplo, para I , 

/ H / 2 i*2jt n R 

/ / (x 2 + y 2 )p r dr dO dz 

-H /2 Jo Jo 

x = Rcos9 , y = f?sen0, x 2 + y 2 = R 2 (r 2 ) 

/ H / 2 p2tt rR 

I I pr 3 dr dddz 

-H /2 Jo Jo 
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, Z 



/ = -R 4 Hp, VOLUMEN = Ttr 2 H 

zz 2 


Masa = M = jmr ¿ H 

De manera similar (sólo que más difícil) se tiene 


/ = \MR 2 

ZZ 2 


I XX = Iyy = \MR 2 + ^MH 2 


De la simetría (o integración), 


^xy 1xz lyz ” 


0 


o 


r \MR 2 + yjMH 2 

0 \MR 2 + ±MH 2 0 


0 


0 


6 . 12 ) 6) (f) = 5r + cf 2 , por lo que 


entonces 


= 5 + 2cí, 6 — 2c 


1 • 


(¿1 = 0!?! = 20^ 


w cl = 


1 ^cl 





_2c 

0 


2 


0 


0 

+ 

2c 


0 


0 " 


' —20 2 “ 
0 

4 c 

+ 

0 


0 

-2 (B + 2 ct) 

2 " 


O 

O 


O 

O 

0i 


4c 

O 


\MR 2 


6.18) Cualquier F(0, 0) razonable probablemente tenga la propiedad de que la fuerza 
de fricción (o momento de torsión) en la articulación i depende sólo de la velo¬ 
cidad de la articulación i, es decir. 


F(9, 0) = 0j) F 2 (0, 0 2 ) ... ,F n ( 0, 9 n )Y 
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Además, cada f¡(9, 6¡) debe ser “pasiva”; es decir, la función debe encontrarse en 
los cuadrantes primero y tercero. 


F t 



** ¡Solución escrita a la luz de una vela como secuela de un terremoto; escala 7.0, 
el 17 de octubre de 1989! 

CAPÍTULO 7 EJERCICIOS SOBRE GENERACIÓN DE TRAYECTORIAS 

7.1) Se requieren tres polinomios cúbicos para conectar un punto inicial, dos puntos 
vía y un punto de destino; esto es, tres para cada articulación, para un total de 18 
polinomios cúbicos. Cada polinomio cúbico tiene cuatro coeficientes, por lo que 
se almacenan 72 coeficientes. 

7.17) Por diferenciación, 

0(í) = 180í - 180f 2 

6(t) = 180- 360f 

entonces, evaluando en t = 0 y t = 1, tenemos que 

0(0) = 10 0(0) = 0 0(0) = 180 
0(1) = 40 0(1) = 0 0(1) = -180 


CAPITULO 8 EJERCICIOS SOBRE DISEÑO DEL MECANISMO DE UN MANIPULADOR 


8.3) Utilizando la ecuación (8.1) tenemos que 

3 

L = ^ + d¡) — (0 + 0) + (0 + 0) + [0 + (U — T)] = U — L 

i =l 


4 -3 4 o 4 n -3 

W = -7rU - = -7r(f/ á - L J ) 

3 3 3 


una 

“esfera” 

hueca 


Ql = 


U - L 


r(í/ 3 - L 3 ) 
8.6) De la ecuación (8.14), 


K total 1000 300 


-i- = 4.333 x 10“ 3 


K 


TOTAL 


= 230.77 


NTM 

RAD 


8.16) De la ecuación (8.15), 

Gttí/ 4 (0.33 x 7.5 x 10 10 )(7r)(0.001) 4 


K = 


32 L 


(32) (0.40) 


0.006135 


NTM 

RAD 


¡Esto es muy insustancial, ya que el diámetro es de 1 mm! 
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CAPÍTULO 9 EJERCICIOS SOBRE CONTROL LINEAL DE LOS MANIPULADORES 

9.2) De la ecuación (9.5), 


6 ¡ V36 - 4 x 2 x 4 

?1 = ”2x2 + 2x2 

s 2 = -1.5 - 0.5 = -2.0 


= -1.5+ 0.5 = -1.0 


quadxit) = c 1 e ' + c 2 e 2t y x(f) = —cqe '—2 c 2 e 
Att = 0 x(0) = 1 = + c 2 

i(0) = 0 = —Cj — 2 c 2 

Si sumamos (1) y (2) obtenemos 


1 = 


por lo que c 2 = — 1 y c 1 = 2. 


x(t) = 2e 1 — e 


-t „- 2 t 


9.10) Usando la ecuación (8.24) y suponiendo el uso de aluminio, obtenemos 

(0.333)(2 x 10 n )(0.05 4 - 0.04 4 ) 


K = 


(4) (0.50) 


= 123,000.0 


( 1 ) 

( 2 ) 


Utilizando la información de la figura 9.13, la masa equivalente es (0.23)(5) = 1.15 
kg, por lo que 


W 

'' rt 


= ^k/^¡=J 


123,000.0 

L15 


327.04 ^ 
_ scg 


Esto es muy alto, por lo que el diseñador probablemente esté equivocado al pen¬ 
sar que esta vibración de vínculo representa la resonancia no modelada más baja. 
9.13) Al igual que en el problema 9.12, la rigidez efectiva es K = 32000. Ahora, la iner¬ 
cia efectiva es / = 1 + (0.1)(64) = 7.4. 


/ 32000 _ _ rad _ 
W^ = J—— = 65.76— = 
7.4 seg 


10.47 Hz 


CAPÍTULO 10 EJERCICIOS SOBRE CONTROL NO LINEAL DE LOS MANIPULADORES 


10.2) Si r = ar' + /i 


y r 1 — Ó D + K v ¿ + K p e 
en donde e = 0 D — 6 


oí = 2 p=509 - 13¿ 3 + 5 


K p = 10 
K v = 2VTo 
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10.10) Sea f = af' + p 

con a — 2, ¡3 = 5xi — 12 
Y f — X D + + k p e, e = X D — X 

k p = 20, k v = 2V20. 

CAPÍTULO 11 EJERCICIOS SOBRE CONTROL DE FUERZA DE LOS MANIPULADORES 

11 . 2 ) Las restricciones artificiales para la tarea en cuestión serían 


ó" 1 

1 

II 

0 

II 

c 


0 

II 

fcT 


11 

O 


O 

II 

> 


0 

11 




en donde a 1 es la velocidad de inserción. 

11.4) Use la ecuación (5.105) con las tramas ¡ri¡ y \B \ invertidas. Primero debe encon¬ 
trar B T. así que invierta T: 


B 

A 


T = 


0.866 0.5 0 -8.66 

-0.5 0.866 0 5.0 

0 0 1 -5.0 

0 0 0 1 


Ahora, 

b F = b a R a F = [ 1 1.73 -3 ]' 

b N = b P A 0RG ® b F + b a R a N = [ -6.3 -30.9 -15.8 ] 7 
.-. S F=[1.0 1.73 -3 -6.3 -30.9 —15.8 ] 7 
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